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The  elastic  behavior  of  the  components  of  a  robot  manipulator  will  tend  to  induce 
both  static  and  dynamic  errors  between  desired  and  actual  trajectories  and  end- 
effector  positions.  Currently,  most  researchers  consider  joint  compliance  -  as  opposed 
to  link  displacements  -  to  be  the  dominant  source  of  these  errors.  This  conclusion 
is  based  on  the  the  fact  that  when  compared  to  the  yielding  typically  seen  in  gears, 
motor  shafts,  bearings,  etc.,  the  links  appear  almost  perfectly  rigid.  However,  cur¬ 
rent  efforts  to  lighten  robot  manipulators  ^and  increase  their  operating  speeds  also 
tends  to  increase  the  significance  of  link  elasticity.  This  study  considers  the  dynamic 
effects  of  elastic  link  displacements  in  a  two-link  robot  manipulato^  as  simulated  by 
a  hierarchy  of  models.  In  all,  five  separate  system  models  are  developed.  The  last 
model,  TFTFEL,  allows  both  manipulator  links  to  bend  in  a  single  plane  and  to  twist. 
Therefore,  the  effects  of  bending-torsion  vibrations  in  each  link  may  be  observed  when 
the  manipulator  attempts  motion  with  an  inertially  asymmetric  payload  grasped  in 
its  end-effector.  This  elasto-dynamic  behavior  is  simulated,  and  results  indicate  a 
definite  disturbance  of  the  joint  angle  trajectories.  The  use  of  structural  damping  to 

eliminate  these  high  frequency  vibrations  and  increase  the  manipulator’s  accuracy  is 
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N  omenclat  ur  e 


gear  ratio 

motor  torque  applied  to  first  joint 
motor  torque  applied  to  second  joint 
length  of  link  one 
length  of  link  two 
acceleration  due  to  gravity 
material  density 

link  cross  sectional  moment  of  inertia 

forward  path  gain 

torque  sensitivity 

D.C.  motor  resistance 

motor  armature  inertia 

load  inertia  at  motor  shaft 

total  inertia  at  motor  shaft 

motor  back  e.m.f.  constant 

motor  voltage  sensitivity 

gravity  torque 

desired  joint  angle 

actual  motor  angle 

actual  link  angle 

first  link  joint  angle 

second  link  joint  angle 

generalized  time  coordinate,  first  link  torsion 
generalized  time  coordinate,  second  link  torsion 
generalized  time  coordinate,  first  link  flexure 
generalized  time  coordinate,  second  link  flexure 
mode  shape,  first  link  torsion 
mode  shape,  second  link  torsion 
mode  shape,  first  link  flexure 
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f(y2)  mode  shape,  second  link  flexure 

t  vector  in  end-effector  coord,  frame  to  eccentric  payload 

e  scalar  distance  to  payload  from  origin  of  end-effector  c.  frame 

GJ  torsional  rigidity 

El  flexural  rigidity 

Mpl  payload  mass 

mi  mass  of  link  one 

m2  mass  of  link  two 

f/iCj/l  i0  first  link  torsional  displacement 
*72(2/21 1)  second  link  torsional  displacement 
first  link  flexural  displacement 
***2(2/21 1)  second  link  flexural  displacement 
Ci  small  angle  due  to  first  link  flexural  displacement 

C2  small  angle  due  to  second  link  flexural  displacement 

/?  (0X  +  62  +  Ci)  •  •  ■  unless  stated  otherwise 

Ai  cross  sectional  area  of  link  one 

A 2  cross  sectional  area  of  link  two 

moment  of  inertia  of  payload  about  axis  X3 
moment  of  inertia  of  payload  about  axis  y3 
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Chapter  1 


Introduction 

When  robot  manipulators  were  first  introduced  into  the  automated  manufacturing 
industry,  they  were  usually  tasked  with  only  the  simplest  repetitive  jobs.  Today, 
however,  they  are  finding  their  way  into  many  different  technical  industries  with 
various  scientific  as  well  as  industrial  applications.  Many  of  these  jobs  place  great 
expectations  and  demands  upon  the  manipulators  -  often  calling  for  high  levels  of 
accuracy,  reliabilty,  speed,  strength,  and  efficiency.  Considering  all  of  these  require¬ 
ments,  and  then  designing  a  suitably  swift-  moving,  mechanically  smooth,  efficient, 
and  powerful  manipulator  with  high  end-effector  accuracy  is  no  easy  task  to  say  the 
least.  One  is  often  forced  into  a  compromise  since  improvement  of  one  characteristic 
often  dictates  a  reduction  in  performance  in  another.  Consider,  as  a  case  in  point, 

the  demand  for  greater  manipulator  strength.  This  problem  has  been  typically  dealt 
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with  through  the  application  of  more  and  stronger  load  bearing  materials  and  more 
powerful  joint  motors  [3].  However,  this  solution  tends  to  increase  the  anmveight  to 
payload  weight  ratio  drastically  e.g.  the  Cincinatti  Milicron  robot  for  which  payload 
capacity  is  only  10%  of  the  system’s  weight.  The  increased  weight  in  turn  creates  the 
need  for  higher  joint  torques,  higher  feedback  gains,  and  causes  greater  overall  power 
consumption.  Efficiency,  speed  of  response,  and  smooth  operation  will  obviously  also 
deteriorate. 

However,  another  option  does  exist.  Specifically,  is  is  possible  to  meet  these 
demands  with  lighter,  more  efficient,  and  knowingly  flexible  robots.  It  is  true  that 
manipulator  performance  and  accuracy  would  be  severely  threatened  by  the  inevitable 
structural  deformations  and  vibrations  that  result  when  such  a  machine  is  expected 
to  operate  at  higher  speeds  and/or  handle  substantial  payloads.  Yet,  indications  do 
exist  that  the  need  to  be  able  to  control  this  type  of  device  is  significant.  For  example, 
future  applications  of  robotics  to  space  exploration  -  some  of  which  has  already  been 
seen  wFh  the  use  of  the  “arm”  on  the  space  shuttle  -  suggest  the  need  to  be  able 
to  effectively  control  lighter,  more  slender  robot  arms  where  link  flexibility  poses  a 
serious  challenge  to  accurate  arm  trajectories  and  end-  effector  positioning.  Even  at 
this  moment,  the  desire  for  very  light  weight  high-speed  robots  has  been  expressed 
through  various  DOD  contracts.  For  example,  the  Army  is  currently  funding  research 
to  develop  reliable  bigh  speed  manipulators  for  use  in  vehicle  refueling  operations, 
and  explosive  ordnance  handling  [9].  Low  weight  is  of  prime  concern  for  ease  of 
mobility,  while  long  link  lengths  are  needed  for  reach  and  powerful  motor  torques  are 


needed  for  potentially  heavy  payloads  (0  —  1500/6s.)-  The  need  for  light  weight,  high 
speed  of  operation,  strength  and  accuracy  coupled  with  the  flexible  displacements  and 
vibrations  that  would  be  expected  obviously  pose  the  need  for  a  mechanism  with  a 
kinematic/dynamic  design  that  considers  this  and  a  control  policy  that  compensates 
for  the  elastic  phenomena. 

These  considerations  motivate  investigations  aimed  at  developing  a  greater  under¬ 
standing  of  the  dynamic  behavior  of  flexible  robotic  systems.  With  this  knowledge 
it  may  be  possible  to  develop  manipulator  control  schemes  in  order  to  minimize  the 
effects  of  link  flexibility  on  the  desired  dynamic  response  and  accuracy  of  the  robot. 

To  date,  a  considerable  amount  of  research  concerning  the  effects  of  elasticity  in 
robot  manipulators  has  been  performed.  Understandably,  a  good  deal  of  time  has 
been  spent  analyzing  the  effects  of  joint  compliance  because  in  many  of  the  robots  in 
use  today,  the  links  themselves  are  short  and  heavy  enough  to  justify  the  assumption 
of  rigidity.  In  these  cases,  the  compliance  observed  is  attributed  to  the  elasticity 
found  in  the  gears,  belts,  tendons,  bearings,  and  hydraulic  lines.  This  problem  has 
been  thoroughly  investigated  by  Spong  [12]. 

In  the  consideration  of  link  deflections,  considerable  research  producing  dynamic 
models  and  suggestions  for  control  strategies  has  also  been  published.  Gebler  con¬ 
siders  a  two  joint,  two  link  manipulator  with  link  flexibility  in  a  single  plane  coupled 
with  joint  compliance[7j.  He  proposes  a  feed-forward  control  stategy  to  correct  the 


link's  tragectory.  A  similar  analysis  is  performed  by  Tang  and  Wangfl  7],  however  they 
also  allow  for  out-of-plane  bending  and  torsional  link  displacements.  Their  result  is 
an  algorithm  which  predicts  the  actual  position  and  orientation  of  the  end-effector 
of  a  two  link  robot.  However,  the  manipulator  considered  has  only  one  moveable 
joint  angle  and  carries  no  payload.  Naganathan  and  Soni  [14]  also  consider  lateral 
deflection  in  two  planes  plus  torsional  displacements  in  a  two  link  manipulator,  but 
instead  resort  to  a  finite  element  model  to  determine  the  nonlinear  effects  of  link 
flexibility.  Nicosia  and  Tomei  [15],  who  use  the  Lagrangian  approach  to  obtain  a 
dynamic  model  of  a  single  and  a  double  link  planar  manipulator,  also  employ  the 
symbolic  algebraic  manipulation  language  MACSYMA  to  assist  their  efforts.  Their 
study  is  limited  to  a  consideration  of  in-plane  link  distortion  only.  Dubowskv  and 
Sunada  [5]  provide  a  powerful  finite  element  routine  which  considers  the  effects  of 
distributed  mass  and  flexibility  and  produces  a  model  of  the  dynamic  behaviour  of 
manipulators  composed  of  arbitraily  shaped  links.  Rakhsha  and  Goldenberg  [16]  use 
the  Newton-Euler  approach  to  develop  a  dynamic  model  of  a  single  link  robot  with 
a  payload.  Lateral  bending  motion  is  considered,  and  the  natural  frequencies  and 
mode  shapes  describing  the  vibratory  behavior  are  found  using  a  constrained  mode 
approach  [18].  Moreover,  the  flexibility  influence  is  modeled  as  a  disturbance  torque 
affecting  the  rigid  body  motion.  This  paper  serves  as  a  good  foundation  for  more 
comprehensive  efforts.  Several  other  works  have  also  been  completed,  however  the 
first  to  consider  and  analyze  the  limitations  of  a  rigid-link  assumption  in  the  dynamic 
analysis  of  manipulators  was  Book.  For  example,  in  1975  he,  along  with  Whitney 
and  Maizzo-Neto  [3],  published  a  paper  describing  a  model  of  a  two  link,  two  joint 


flexible  manipulator.  Lateral  in-plane  link  flexibility  was  allowed  in  each  link,  and 
various  control  schemes  were  compared  and  contrasted.  Specifically,  individual  joint 
control  (IJC)  was  compared  and  contrasted  with  the  feedback  of  flexible  coefficients 
(FFC).  Since  then,  Book  has  made  various  other  contributions  including  models  and 
suggested  control  methods  [2]. 

In  light  of  these  efforts,  the  purpose  of  this  research  was  to  generate  explicit 
closed-form  models  capable  of  simulating  the  motion  of  an  arbitrary  two-link  revo¬ 
lute  jointed  manipulator  wherein  single-plane  and  torsional  link  flexure  may  occur 
while  the  arm  is  tasked  to  move  various  payloads.  Dynamic  behavior  is  also  consid¬ 
ered  when  the  payload  is  grasped  at  a  point  removed  from  its  mass  center  -  hence 
making  it  inertially  asymmetric.  Following  the  analysis  performed  by  Book  in  ’86  [2], 
first  the  complete  kinetic  and  potential  energy  expressions  for  each  system  are  found. 
The  vibratory  displacements  are  represented  through  the  method  of  assumed  modes 
[13],  and  each  complete  system  Lagrangian  is  then  used  to  derive  the  set  of  governing 
equations  of  motion  for  each  model  which  consists  of  a  set  of  second  order  nonlinear 
differential  equations.  The  dynamic  behavior  of  the  systems  is  simulted  on  a  VAX 
8560  digital  computer  wherein  a  straightforward  IJC  control  policy  is  applied.  The 
effectiveness  of  this  control  method  is  observed  and  compared  with  the  same  policy’s 
strong  effectiveness  on  a  rigid  two-link  manipulator  with  a  payload.  Deviations  in 
the  joint  angle  trajectories  and  the  end-effector  position  accuracy  are  examined  and 
again  the  flexibile-link  robot  performance  is  compared  to  that  of  the  rigid  link  ma¬ 
nipulator.  Furthermore,  the  effects  of  increasing  payload  inertia  are  considered  along 


with  possible  compensation  techniques 


Chapter  2 

Development  of  System  Models 

In  this  study,  five  separate  system  models  have  been  developed.  Each  model  simulates 
the  three  dimensional  motion  of  an  upright  serial  two-link  manipulator  carrying  a 
payload  fixed  at  its  end-effector  (see  fig. 2).  Gravitational  effects  are  included,  and 
each  model  introduces  various  elastic  degrees  of  freedom.  Furthermore,  the  links  are 
assumed  to  behave  as  continuous  slender  beams  modeled  by  the  Bernoulli  -  Euler 
beam  equations  [13],  and  power  is  delivered  to  the  system  by  standard  servomotors. 

The  first  model,  RR  (fig.  2),  simulates  the  performance  of  a  two- link  robot  ma¬ 
nipulator  wherein  the  links  are  assumed  to  be  absolutely  rigid.  This  model  serves  to 
provide  a  base  of  reference  for  “ideal”  system  behavior. 


In  the  second  model,  TT  (fig.  3),  each  link  is  permitted  to  vibrate  in  torsion  about 
an  axis  passing  longitudinally  through  the  center  of  each  link's  cross  section.  The 
payload  is  gripped  firmly  at  the  end-effector,  and  the  system  motion  is  then  analyzed 
following  an  initial  twist  to  the  end  of  the  second  link.  The  third  model,  TTEL  (fig. 
4),  extends  this  problem  by  allowing  the  payload  to  be  gripped  eccentrically  -  i.e.  not 
at  its  center  of  gravity.  No  initial  torsional  excitation  is  given  in  this  case  because 
even  rigid  body  movement  will  excite  second  link,  and  then  first  link  vibration. 

Second  link  in-plane  flexural  vibration  is  then  added  to  the  problem  defined  by 
model  TTEL,  thus  raising  the  number  of  degrees  of  freedom  in  the  fourth  model, 
TTFEL  (fig.  5),  to  five.  Here,  the  payload  may  be  gripped  at  or  off  its  center  of 
gravity  -  which  will  tend  to  excite  second  link  bending  torsion-vibration.  Finally, 
the  fifth  model,  TFTFEL  (fig.  6),  permits  each  link  to  vibrate  both  torsionally  and 
laterally  thus  raising  the  number  of  degrees  of  freedom  in  the  system  to  six.  In  this 
case,  the  payload  may  also  be  held  at  any  point. 

Each  of  these  system  models  yields  a  governing  set  of  coupled  second  order  non¬ 
linear  differential  equations  of  motion.  The  first  step  in  deriving  these  equations  is 
the  development  of  a  proper  kinematic  representation  for  each  system.  Specifically, 
robot  arm  kinematics  is  concerned  with  analytically  describing  the  manipulator’s 
and  end-effector’s  spatial  orientation,  which  entails  mathematically  illustrating  the 
relationships  between  the  joint  variables  and  the  operating  space.  This  is  actually  a 
forward  kinematics  problem  which  results  in  a  mathematical  description  of  the  robot’s 
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position  and  orientation  based  upon  a  prior  knowledge  of  the  link  parameters  and  the 
joint  angle  trajectories  as  a  function  of  time.  It  should  be  mentioned  that  the  De- 
navit  Hartenburg  formulation  is  very  useful  in  forward  kinematics  for  it  conveniently 
represents  the  spatial  relationships  between  the  coordinate  frames  of  the  adjacent 
links  forming  the  manipulator  in  a  compact  4x4  homogeneous  transformation  ma¬ 
trix  [6].  Thus  the  forward  kinematics  problem  is  reduced  to  the  problem  of  obtaining 
the  appropriate  4x4  homogeneous  matrix  which  will  yield  the  overall  relationship 
between  the  end-effector  and  the  stationary  base  or  “inertial”  reference  frame.  In  this 
study,  3x3  rotation  matrices  and  accompanying  relative  position  vectors  between 
the  origins  of  the  joint  coordinate  frames  is  used  in  lieu  of  the  Denavit  Hartenburg 
technique. 

Once  the  kinematics  have  been  formulated,  the  derivation  of  the  equations  of  mo¬ 
tion  may  begin.  Note  that  the  development  of  a  proper  control  scheme  is  facilitated 
by  reference  to  the  closed  form  governing  equations,  and  the  resulting  dynamic  be¬ 
havior  of  the  manipulator  is  therefore  a  direct  function  of  the  efficiency  and  accuracy 
of  them.  There  are  a  variety  of  methods  available  to  develop  them,  however  the  two 
conventional  approaches  are  the  Newton  -  Euler  (NE)  formulation  and  the  Lagrange 
-  Euler  (LE)  formulation  which  rely  on  the  principles  of  Newtonian  and  Lagrangian 
mechanics,  repectively.  These  two  methods  are  favored  in  fundamental  studies  and 
analysis  because  of  their  systematic  methods  and  reliability. 

The  NE  approach,  which  was  developed  in  order  to  reduce  the  computational 
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burden  of  numerically  solving  these  equations,  involves  relatively  complex  vector  ma¬ 
nipulations  and  appears  to  be  quite  uninviting.  Yet  once  properly  applied,  it  allows 
for  a  fast  computational  algorithm  in  which  the  time  needed  for  calculations  is  lin¬ 
early  proportional  to  the  number  of  joints  of  the  robot  arm  and  is  independent  of  its 
configuration  [6].  Thus,  this  method  allows  for  the  real-time  control  of  the  manipu¬ 
lator. 

The  LE  method,  on  the  other  hand, provides  a  clearer  and  more  appealing  sys¬ 
tematic  method  to  obtain  the  manipulator’s  governing  equations  of  motion.  Based 
on  Lagrangian  dynamics,  it  relieves  one  of  the  burden  of  expressing  and  evaluating 
complex  vector  relationships,  and  requires  simply  the  determination  of  the  mecha¬ 
nism’s  proper  kinetic  and  potential  energy  expressions.  The  resulting  equations,  as 
stated  earlier,  are  nonlinear  and  include  coupling  forces  between  the  joints  -  such  as 
Coriolis  and  centrifugal  forces  -  and  gravitational  effects.  One  also  notices  that  the 
LE  formulation  clearly  expresses  these  terms  as  an  explicit  function  of  the  manip¬ 
ulator’s  physical  characteristics  such  as  link  lengths  and  masses,  material  stiffness, 
and  payload  mass.  As  such,  the  LE  approach  yields  the  explicit  closed  -  form  state 
equations  necessary  for  a  dynamic  analysis  and  control  scheme  design  [6].  Through 
the  use  of  conventional  and  compact  transformation  matrix  relationships  (  such  as  the 
Denavit  Hartenburg  formulation  previously  mentioned  )  this  method  also  lends  itself 
to  a  smooth  transition  from  analytic  model  to  coded  algorithm  needed  for  computer 
simulation  of  the  robot’s  movement. 


Of  the  methods  described,  the  LE  approach  generates  equations  which  are  the 
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most  difficult  to  integrate  numerically.  Thus,  this  method  really  does  not  lend  itself 
to  use  in  the  real  -  time  control  of  a  robot  manipulator,  for  which  most  people  rely  on 
more  efficient  NE  and  d’Alembert  techniques.  (  Variations  of  the  basic  LE  method 
are  available,  however,  such  as  the  recursive  Lagrangian  formulation  suggested  by 
Hollerbach  in  1980  [10]  which  alters  a  manipulator’s  standard  LE  eqautions,  permit¬ 
ting  their  application  to  real  -  time  control  schemes.)  However,  since  the  purpose  of 
this  study  has  been  to  obtain  insight  to  the  elasto  -  dynamic  behavior  of  these  systems 
from  computer  simulations  of  their  motion,  the  LE  method  was  considered  to  be  quite 
adequate.  Furthermore,  its  systematic  application  allows  for  a  simplified  treatment 
of  the  great  complexities  normally  introduced  by  the  material  flexibility.  Also,  the 
closed  -  form  equations  produced  are  then  easily  translateable  into  FORTRAN  codes. 


2.1  Model  RR 


We  define  the  system  Lagrangian,  L,  to  be  the  difference  between  the  kinetic  energy 
T  and  the  potential  energy  V  of  the  system,  ie. 

L  =  T  —V 

Here  T  and  V  are  themselves  functions  of  variables  that  give  the  position  and  orien¬ 
tation  of  the  system  in  a  “base”  or  inertial  frame  of  reference. 


To  obtain  the  kinetic  energy  of  a  rigid  body  in  three  dimensional  motion  relative 


Fig.  1 


to  an  inertial  frame  of  reference  XYZ,  a  moving  reference  frame  or  “body  frame”  xyz 


is  fixed  to  the  body’s  mass  center  G.  A  vector  r  is  defined  to  extend  from  the  origin 


of  the  inertial  frame  to  the  origin  of  the  body  frame.  Another  vector  p  is  defined  to 


extend  from  the  origin  of  the  body  frame  to  a  generic  point  p  in  the  body.  (See  fig. 


Then,  with  the  vector 


R  =  r  +  p 


the  velocity  of  the  point  in  the  body  is  then  expressed  as 


V  =  r  +  u ’>  x  p 


■  where  Co  is  the  angular  velocity  of  the  body  at  the  instant  considered. 


The  total  kinetic  energy  expression  becomes 
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Applying  this  method  to  the  rigid  link  revolute-joint  serial  link  manipulator  of 
Model  RR,  “body  frames”  of  reference  are  first  placed  at  the  revolute  joints  as  shown 
in  fig.  2. 

The  vectors  depicted  in  fig.  1  are  defined  below: 
rpi  =  from  origin  of  first  link  coordinate  frame  to  a  generic  point  in  link  1 
re i  =  from  origin  of  first  link  coordinate  frame  to  end  of  link  1 
fp 2  =  from  origin  of  second  link  coordinate  frame  to  a  generic  point  in  link.2 
fpL  =from  the  origin  of  the  inertial  frame  to  the  end  of  link2 

Therefore, 

Vpl  —  oJi,nj;1  x  rp j 

rp2  -  'el  ^  p2 

and  so 

Vp2  =  ^linkl  x  %  +  Unlink 2  x  T%2 
rpL  =  re  i  +  re2 

Vpi  =  U![inj t!  X  -f-  &Hnk2  x  ^2 

assuming  rigid  links.  (Note  that  the  superscript  “o”  indicates  with  respect  to  the 
inertial  frame  of  reference.) 

At  this  point,  further  computations  can  be  greatly  simplified  and  the  non-rigid 
body  terms  which  will  appear  later  due  to  link  flexibility  can  be  accounted  for  far 


more  easily  if  rotation  matrix  relationships  are  employed  instead  of  the  above  vector 
expressions.  As  the  name  implies,  a  rotation  matrix  gives  the  “rotated”  orientation 
of  one  link’s  coordinate  frame  with  respect  to  another’s.  For  example,  R °  expresses 
the  rotated  orientation  of  the  first  link’s  coordinate  frame  with  respect  to  the  inertial 
frame  of  reference.  It  should  be  mentioned  that  the  standard  3x3  rotation  matrix 
does  not  express  the  translated  position  of  the  coordinate  frame  origin  as  do  the  stan¬ 
dard  4x4  homogenous  transformation  matrices  usually  employed  in  robotics  studies. 
Instead,  this  displacement  is  represented  throughout  this  analysis  by  a  separate  rela¬ 
tive  position  vector. 


Thus,  the  following  rotation  matrices 

are 

defined: 

r 

1 

0 

0 

R°l  = 

0 

COx 

-S0i 

0 

SOx 

COx 

where  C6\  and  S9\  are  the  cosine  and  sine  of  the  first 

tively. 
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Therefore,  in  this  case, 


r°v2  =  B°^el  +  R°xR\fp2  =  R°xreX  +  R°2rp2 

Vp2  =  RxRel  +  R<2rp2 

0 

—  OiliSOi  —  {0\  +  ^2)j/2-?(0!  +  02) 

l\0\  +  (^1  +  92)y2C{9\  +  02) 
rvL  —  R°\R<:\  +  R%re2 

VpL  =  Rxre  1  +  ^2^2 

0 

-ll9lS01-l2(6l+02)S(9l+02) 
l\9\C9i  4-  l2{9\  4-  92)C(9x  +  92) 

At  this  point,  the  kinetic  energy  expressions  may  now  be  defined 

1  Ri 

Tl, nfcl  =  2  Jo  •  Upl  dy^ 


Assuming  the  links  to  be  uniform,  this  becomes 
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Also, 


Tlink2  —  2 Vp2  •  ^p2^2  —  ^  m2  [(^Ml)2  +  f|(^l  T  ^)2/3  +  l2C^(^l  +  $2)] 

Tpayload  =  ^ ^vL^°pL  *  VpL  =  2^pL  ^(^1  +  ^2^  +  2$l/l bCO^l  +  02)] 

In  this  first  model,  where  each  link  is  assumed  to  be  rigid,  the  only  potential 
energy  that  needs  to  be  accounted  for  is  that  due  to  gravity.  The  rotation  matrix 
relationships  just  established  allow  this  to  be  conveniently  expressed  as 

Viinki  =  J  gr°pidmi 

Vunk2  =  J  gr°p2dm2 

Vpayload  =  MpL9PpL 

Finally,  the  system  Lagrangian  can  be  defined  as  follows 

L  =  Tlinkl  +  Tlink2  T  Tpayload  ^linkl  Vlink2  T payload 

and  from  this  the  manipulator’s  governing  differential  equations  of  motion  can  be 
derived  in  terms  of  the  system’s  generalized  coordinates  0x(t)  and  02(t). 

d/dt  {dL/d6x)  -  dLfdOx  =  Tx 
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d/dt{dL/d92}  -  dL/dO 2  =  T2 


Omitting  all  of  the  computational  steps,  the  resulting  equations  of  motion  for  the 
rigid  two  link  manipulator  (Model  RR)  are  then  obtained  through  the  application  of 
these  expressions.  Refer  to  Appendix  B  for  the  equations  in  their  complete  form. 

2.2  Model  TT  and  Model  TTEL 

The  principles  used  to  derive  the  equations  of  motion  for  the  previous  case  are  also 
applied  in  the  derivation  of  models  TT  and  TTEL.  However,  the  torsional  displace¬ 
ments  which  are  now  permitted  to  occur  in  each  link  and  the  consequences  of  this 
motion  have  to  be  accounted  for  in  the  system’s  kinematic  representation  and  in 
the  kinetic  and  potential  energy  expressions  forming  the  system’s  Lagrangian.  This 
has  been  accomplished  through  the  use  of  the  method  of  assumed  modes  [13]  and 
“special”  rotation  matrices  containing  the  flexibility  variables. 

Specifically,  the  torsional  displacement  in  links  one  and  two  have  been  identified 
as  t)  and  r]2(y2,t)  ,  respectively. 

The  method  of  assumed  modes  is  applied  to  express  each  of  these  displacements 
as  a  summation  of  the  products  of  a  generalized  time  coordinate  and  an  associated 
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mode  shape.  In  other  words,  let 


m(yut)  =  £  A>(0r,(yi; 


V2{V2,t)  = 


where  r,(yi)  and  A,(y2)  each  represent  the  first  mode  shape  of  a  cantilever  shaft 


and  payload  in  torsional  vibration  for  i=l,  second  mode  for  i='2,  and  so  on.  The 


fundamental  mode  shape  is 


r i (?/)  =  Ai(y)  =  Ai  sin (fiy) 


where  ft2  =  uj2I /GJ  [18].  Note  that  Appendix  A  focuses  on  the  difficulties  introduced 


here  by  the  time  varying  inertial  load  present  at  the  end  of  the  first  link  due  to  the 


movement  of  the  second  link. 


In  an  analysis  completed  by  Book  [3],  a  two  mode  shape  approximation  was  used  to 


represent  flexural  link  displacements  for  the  reason  that  the  amplitudes  of  the  higher 


mode  shapes  were  assumed  to  be  small.  In  this  study,  all  flexural  displacements  have 


been  represented  with  a  single  mode  approximation,  ie. 


*h(yi,0  =  £  A,(t)r,(y1)  ss  A1(t)T1(y1) 


V2{V2 ,t)  =  £a;(t)A,(y2)  ~  ot1(t)A1(y2) 


Furthermore,  to  maintain  kinematic  accuracy,  it  was  also  decided  to  employ  a 


rotation  matrix  to  account  for  the  re-orientation  of  the  second  link's  coordinate  frame 


due  to  the  twisting  of  the  first  link. 


ft# 


m 


m 


st 


Specifically,  fig.  3  illustrates  how  the  second  link  coordinate  frame  experiences  an 
additional  small  rotation  about  axis  y\.  Hence,  the  matrix  R °  used  in  the  development 


A  similar  matrix  representation  is  also  required  to  properly  develop  the  kinetic- 
energy  expresssions  for  the  case  when  the  payload  is  grasped  eccentrically.  This 
situation  has  been  represented  in  model  TTEL  by  placing  a  point  mass  at  a  distance 
from  the  end  of  link  two,  thus  simulating  an  eccentric  grasp  (see  fig. 4). 


Therefore,  the  required  rotation  matrix  R"  —  ROT(y2,y2(l2,t))  can  be  defined  as 
follows: 

CM/2,f))  0  S(y2(l2,t)) 

R"  =  o  10 

~S(r,2(l2,t))  0  C(rj2(l2,t)) 

R"  permits  the  calculation  of  the  rotation  matrix  R®  that  defines  the  re-orientation 
of  the  end-efFector  coordinate  frame  £32/323  relative  to  the  inertial  frame  of  reference 
XYZ  due  to  the  motion  of  each  joint  angle  and  the  torsional  displacements  in  each 
link. 

po _  pO  pi  pi  p  11 


r%  = 


l  -  t]Xt]2C62  tjiS92  tj2  +  rjiT]2C62 

S91t)1  +  T  92)  C(0\  +  02)  77i7?2‘5#i  —  S(0 1  +  02) 

—COlTji  —  7]2C{9\  +  02)  S(0 1  +  0l)  —yiT}2C0\.  T  C(0 ,  +  02 ) 


where  tjj  =  t)i(lut)  and  rj2  =  rj2{l2,t )  . 


At  this  point,  the  development  of  the  kinetic  energy  due  to  each  link’s  motion  may 
begin.  As  shown  earlier,  a  vector  fp  1  is  defined  to  extend  from  the  origin  of  the  first 


link  s  coordinate  frame  to  an  arbitrary  point  in  the  first  link.  Relating  this  vector  to 


the  inertial  frame  through  R°  yields 


vpi  —  ^i^*pi  —  —y\0\S6i 

yiOiCOi 

Similarly,  the  angular  velocity  ffx(y ut)  due  to  link  one’s  torsional  vibration  is  related 


to  the  inertial  frame  through 


1  0  0 


yiiyi,*)  =  RiVi  =  o  C6l  -S6l  rji(yut) 
0  S0!  C6i  0 


yl(yut)=  coMyut) 

S0im{y\,t) 


Thus, 


Tunk\  =  \JQ  p(y\)A{y\)  (vU  •  t^i)  dy'  +  \l  7(j/i)  (^I(yi» 0  •  vliyu  <))  dvi 

Tan*!  =  \AiP9\  £  y{dyx  +  T 21(y1)dy1 


assuming  a  one  mode  approximation. 


The  expression  for  the  kinetic  energy  of  the  second  link  also  follows  the  example 
set  by  the  earlier  derivation. 


>4. 


r°p2  =  Rif  el  +  R°fp2 


v°p2  =  R\fe  1  +  R°2fp2 


3/2  (yi92C92  +  r/S02) 

vp2  —  '  —BiliSOi  —  y2  {0iS(9i  +  92)  +  92S(9i  -j-  92)  —  S9ir/iS92T)i )  ' 

9ihC9i  -f  3/2  ( 9\C{9i  +  92)  ~t-  92C(9i  +  $2)  —  i)\C9iS92r)i'j 
. . .  again  where  rj  1  =  T]i(li,t)&nd  771  = 

Furthermore,  the  angular  velocity  due  to  the  torsional  vibration  of  link  two  can 
also  be  related  to  the  inertial  frame  of  reference  as  follows 

if2{y2,t)  =  R1V1  +  R%y2 


Vi(lut)v2(y2,t)S92 

—  C{9\  +  92)fi2(y2,  t)  +  C9irh(li,  t) 

S(9X  +  92)rj2(y2,t)  +  S0ir]i(li,t) 


And  so, 


Tlink2=\Jo  P^A2^  fe  *  ^2)  dy2  +  \J0  7(^)  (*72(2/2,0  *^2(^,0)  dyi 


In  model  TT,  the  payload  is  grasped  at  its  center  of  gravity  and  is  therefore 
^presented  as  a  rigid  body  mounted  at  the  end  of  link  two.  Hence,  the  kinetic  energy 


due  to  the  motion  of  the  payload  must  account  for  the  movement  of  its  center  of 
gravity  (developed  in  Model  RR)  and  the  body’s  rotation  about  the  center  of  gravity 
due  to  the  twist  at  the  end  of  link  two. 


T pay  load  rotation  —  g  t) 


However,  if  the  payload  is  not  grasped  exactly  at  its  center  of  gravity,  as  shown 


in 


fig.  4,  then  the  kinetic  energy  due  to  the  motion  of  the  payload  is  found  as  follows 


r 


pL 


=  R°S'X 


+  R^r  e2  +  R®e 


where 


v^L  —  R°rel  +  R°re2  +  R%e 

Tpa yload  =  l^^pL^pl,  •  VpL 


The  gravitational  energy  expressions  previously  obtained  in  model  RR  also  apply 


to  these  two  models,  however  the  elastic  potential  energy  levels  due  to  link  torsion 


must  now  be  included  as  well. 


Vunkixias.  =  \  [  GJ{yi){dT]X{yut)/dyx)2  dyx 
l  Jo 

=  tGJA2(t)  jV'.ta))2*, 

=  \l  (dri2(y2,t)/dy2)‘‘  dy2 


assuming  uniform  links. 


GJa\t)  £  (X'M1)2 iy2 


Finally,  the  additional  gravitational  potential  energy  due  to  an  eccentrically  grasped 
payload  is  easily  included  as 

tpZ,  grav.  —  MpL  <7  f  llS9 i  +  l2S(di  +  #2)  +  e  (C($l  +  $2)  ~  TfcTllCOi  —  C9\r)\  —  T]2C(9i  +  62))  ] 

. . .  where  rji  =  r}X(lx,t)  and  t)2  =  V2(h,  t ) 


The  Lagrangian  for  models  TT  and  TTEL  is  then  formed  as  the  difference  between 
the  sum  of  the  kinetic  and  the  sum  of  the  potential  energy  expressions  pertaining  to 
each.  Unlike  the  previous  derivation  of  model  RR,  the  current  two  models  incorporate 
four  degrees  of  freedom  each.  Therefore,  models  TT  and  TTEL  are  both  governed  by 
a  set  of  four  coupled,  second  order,  nonlinear  differential  equations  of  motion  -  which 
are  derived  as  follows  : 

d/dt{dL/de1}-dL/de1  =  tx 

d/dt  {di/de2}  -  dL/ee 2  =  t2 
d/dt{dL/d\1}  -dL!d\x  =  0 
d/dt  {dL/doti}  —  dL/dai  =  0 


The  resulting  equations  of  motion  are  listed  below  in  an  abbreviated  format.  The 
equations  can  be  obtained  in  explicit  form  by  referring  to  the  disscussion  in  Appendix 
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The  form  in  which  these  equations  appear  will  also  be  used  in  the  following  cases. 
Note  that  the  first  coefficient  matrix  on  the  far  left  is  equivalent  to  the  system’s 


inertia  matrix.  The  second  matrix  contains  the  second  derivatives  of  the  system’s 
generalized  time  coordinates.  The  third  matrix  from  the  left  contains  the  system’s 


complex  damping  terms,  its  Coriolis  and  centripetal  terms,  and  various  velocity  cross- 
product  coupling  terms.  The  fourth  matrix  contains  the  system’s  stiffness  terms,  and 
its  gravitational  terms.  Finally,  the  far  right-  hand  matrix  contains  the  system  forcing 
functions,  which  in  all  cases  are  the  motor  torques  applied  at  the  first  and  second 
revolute  joints. 


2.3  Models  TTFEL  and  TFTFEL 


The  problem  defined  by  model  TTEL  is  extended  in  model  TTFEL  by  permitting 
lateral  second  link  flexure  to  occur,  and  model  TFTFEL  takes  this  one  step  further 
by  allowing  lateral  flexibility  in  both  of  the  manipulator’s  links.  As  was  done  earlier 
to  define  torsional  link  vibrations,  these  lateral  flexural  displacements  are  represented 
through  the  method  of  assumed  modes  in  a  one  mode  approximation.  Moreover,  the 
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effect  that  the  added  degrees  of  freedom  have  upon  the  orientation  of  link  coordi¬ 
nate  frames  is  expressed  through  additional  -  and  more  complex  -  “special”  rotation 
matrices.  (See  fig. 5  and  fig. 6). 

Specifically,  the  lateral  single-plane  bending  of  link  one  is  designated  in  model 
TFTFEL  as  Wi(yi,t).  The  same  motion  of  the  second  link  is  designated  as  w-2(y2-t) 
in  both  models  TTFEL  and  TFTFEL.  Also,  the  single  mode  approximation  of  these 
displacements  is 

OO 

wi(yut)  =  » <?i(O0t(yi) 

t=l 

OO 

t"a(ya,0  =  ~  M*)ei(ya) 

.=1 

where  V’i(yi)  and  ^1(2/2)  each  represent  the  fundamental  mode  shape  of  a  cantilever 
beam  with  payload  in  lateral  vibration  [13].  ie. 

V’i(y)  =  fi(y)  =  A  j(sinh/fy-sin/?y)  -  (cosh  0y  -  cos /?j/)j 

where  =  pA\u2 /El  and  A  is  an  arbitrary  constant. 

Just  as  rotation  matrices  were  employed  in  the  kinematic  description  of  models 
TT  and  TTEL  to  account  for  coordinate  frame  rotations  as  a  result  of  torsional  link 
flexure,  “special”  rotation  matrices  are  also  employed  in  both  of  these  models  to 
describe  the  coordinate  frame  re-orientations  due  to  the  lateral  flexure  at  the  link 
ends. 

Specifically,  due  to  the  additional  lateral  flexure  at  the  very  end  of  link  two,  the 
end-effector  coordinate  frame  X3J/323  rotates  through  a  small  angle  (2  about  axis  ,r2. 
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This  rotation  is  in  addition  to  the  rotation  through  small  angle  t]2{12 1  0  about  axis  ij2 
that  the  end-effector’s  coordinate  frame  already  experiences  due  to  the  link’s  torsional 
vibration  (see  figs.  7  and  7.1). 


This  small  angle  £2  is  defined  as  follows 


dw2{y2,t) 


which  in  a  single-mode  approximation  becomes 


C2  =  £M<K( 


Thus,  the  matrix  R%  used  to  determine  the  payload  kinetic  energy  for  the  case 
described  b>  model  TTFEL  becomes 


pO  _  DO  Tj!  Dl  P H  Dill 


where 


&l  =  ROT  (xuex) 


R'  =  ROT(yi,r]l(ll,t)) 


R\  =  ROT{x  2,e2) 


R"  =  ROT(x2,  C2) 


/?'"  =  ROT(y2,T]2{l2,t)) 
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and  where 


ie.  R"  =  R0T(x2,  C2)  • 
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1  0  0 
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Employing  small  angle  approximations,  i?°  becomes 


1  —  J?2»hC(^i  +  ^2  +  C2)  »7i  •S'  (^2  +  C2)  Sr)2  +  Ct)2T]iC(0i  +  62  +  C2) 

f?i^i  +  ViS{0\  +  62  +  C2)  C(C 2  +  +  ^2)  thSOiSrfr  -  Ct)2S(9i  +  02  +  C2) 

—rfrCOi  —  t)2C(6i  +  62  +  C2)  ^(C2  +  4-  #2)  Ct)2C(0\  +  02  +  C2)  —  f)\C6\Srf2 


It  is  also  noted  that  the  lateral  flexibility  of  link  two  dictates  no  change  in  the 
matrix  R%  as  it  is  defined  in  model  TTEL.  On  the  contrary,  the  matrix  R°  used  in  the 
kinematic  description  of  model  TFTFEL  differs  for  the  fact  that  the  effects  of  first 
link  lateral  flexure  must  now  be  included  in  it  in  order  to  express  the  re-orientation 
of  the  second  fink  coordinate  frame.  In  other  words,  the  second  link  coordinate  frame 
not  only  rotates  through  small  angle  about  axis  y\  ,  but  it  also  rotates  through 

small  auagle  £i  about  axis  xx  due  to  the  flexure  Wx(li,t)  at  the  end  of  link  one  (see 
figs.  8  and  8.1). 


This  small  angle  is  defined  as 


Ci  =  2Lqj(t)i'jVi)  ~  4i(0i'i(ti) 

j= i 


As  a  result,  R%  for  model  TFTFEL  becomes 


where 


Therefore, 


n>0  _  pO  p/  p a  pi 

/i2  —  /Xj  ^  ^  /I2 


BZ^ROTinA) 

R>  =  ROT(xl,(l) 

R"  =  ROT(y\,ih{l\,t)) 
R\  =  ROT(x2,02) 

1  0  0 
#  =  o  CCi  -5Ci 
o  5Ci  CC, 


1 

7?l502 

tj\C92 

S(01  +  Cl)7?! 

C/3 

-SI 3 

—  C(01  +  Cl)7?! 

5/3 

C/3 

where  /3  =  (0j  +  02  +  Ci)  and  ^  =  1 71  (/j ,  <)  . 


Moreover,  an  additional  consequence  of  the  lateral  flexibility  of  the  first  link  is 
that  the  rotation  matrix  R%  used  in  model  TFTFEL  becomes  even  more  complex  : 


pO  _  pO  p'  p"  pi  p"'  p«" 

Jl-j  —  it  j  ^  -*^2 ^  ^ 


where 


R°  =  R0T{xu91) 
ff  =  ROT(xu(  i) 

R"  =  ROT(yi,Vl(lut)) 
R\  =  ROT(x2,02) 
R!"  =  ROT(x2,  C2) 


Therefore, 


Crft  -  STfi^CiOi  +  <2) 


r)iS(02  +  C2) 


■S'  ^2  +  Crfyr]\C(&2  +  C2) 


Ct)2t)iS{9i  +  Ci)  +  Sr)2S{0  +  C2)  C(0  +  (2)  Sr^rjiS^i  +  Ci)  —  Ct)2S(/3  +  C2) 

-CyayiCffli+CO-^C^  +  Ca)  5(/3  +  C2)  -Si?2»7iC(<?i +Ci)  +  Cr?2C(/?  + C2) 

. . .  assuming  small  angle  approximations. 


At  this  point,  the  kinematic  descriptions  for  both  models  TTFEL  and  TFTFEL 
is  complete,  and  it  is  now  possible  to  develop  the  proper  kinetic  energy  expressions 
needed  for  the  Lagrangian  of  each.  Specifically,  for  model  TTFEL 
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assuming  a  one  mode  approximation. 


Moreover,  the  kinetic  energy  for  the  second  link  becomes 


r° 


—  RiTfi  -f-  p2 


P  2 


v°p2  —  R°re  i  +  R%rp2  +  R®rp2 


where 


0 

0 

rp  2  =  < 

J/2 

1  rp  2  =  < 

0 

w2{y2,t) 

i  J 

W2(j/2,f) 

(  r}xW2(y2,t)Cd2  +  +  hi  SO?)  +  U’2(y2,<)(hiC’02  -  fljSMi) 


>2 


— h#iS0i  —  S(0i  +  92)w2(y2, t)  —  y2(9\  +  92)S(9 i  +  02)  —  w2{y2, 0(^i  +  92)C{9\  +  02)  f 


l\Q\C9\  +  C(9 1  +  92)w2(y2,  t)  +  y2{9\  +  ®2)C((?i  +  92)  —  u>2(y2,t)(9i  4-  02)S(9\  4-  #2) 


(  note  Th  —  hi(^iiO  )  and  so, 


Tunk2  =  ^Jo  p(2/2)A2(y2)  (v°p2  *^2)  dV*  +  \J  /(ift)  (^(j/2,<)  •rfc{y2,tj)  dy 


1  rl* 


The  total  kinetic  energy  produced  by  the  motion  of  a  properly  grasped  payload 
includes  the  energy  associated  with  the  motion  of  the  load’s  center  of  gravity,  and 
the  energy  of  the  two  rigid  body  rotations  the  load  experiences  due  to  the  lateral  and 
torsional  vibrations  at  the  end  of  link  two  (see  fig.  9).  In  other  words, 


"*  IP*  Jr*.  T\jcrjcr\xr 


v°pL  =  R°rel  +  R%re2  +  i?°fe2 


and  therefore  the  total  kinetic  energy  associated  with  the  motion  of  the  payload 
becomes 

.  {£„  +  +  5/,,  {d'UhJMdyidtf 


Tpayload  =  •  <&,  +  -Iy,a2(tlX,(l2l  +  \lt,b2(t)c‘ t' 


where  /V3  and  IX3  are  equivilent  to  the  moments  of  inertia  of  the  payload  about  axis 
j/3  and  x3  ,  repectively  (see  fig. 9). 


On  the  other  hand,  when  the  payload  is  grasped  eccentrically,  the  complete  kinetic 
energy  expression  is  conveniently  found  through  the  use  of  rotation  matrix  R®  (recall 
that  an  eccentric  load  has  been  modeled  as  a  point  mass  displaced  a  distance  e  from 
the  origin  of  the  end-effector  coordinate  frame). 


r%L  =  R\?'  1  +  R°2^2  +  R°3e 


t°pL  =  R°S'i  +  R°2re  2  +  R°2fe2  +  R°3e 


Tpayload  n  ^pL^pi,  *  ^pL 


This  step  completes  the  kinetic  energy  formulation  for  model  TTFEL.  For  model 
TFTFEL,  the  total  system  kinetic  energy  expressions  are  as  follows 


rpl  =  R°rpi 


v°x  =  f^fp  i  +  R^fpi 


where 


rpi  —  i  yt 


Wi(yi,i) 


. . .  and 


-  •  -6i  (yiSOi  +  wi(yi,t)C0i)  -  wi{yi,t)S6x  ' 

0\  (yiCOi  -  wi(yi,t)S9i )  +  wi(yi,t)C$i 

Tunki  =  \j1  P{V\)MVi)  (*%i  •  ^i)  dyi  +  \j0'  y »’  *)  *  *))  dyi 


Furthermore,  for  the  second  link 


r°p2  =  R°re  i  +  R°2rp2 
v°p2  =  R°xfe  1  +  R°thi  +  R°2Tp2  +  R°2rp2 


& 


TfiC62W2(y2,t)  +  ^2(771 02^02  +  V\S02)  +  t»2(j2i  t)(VlC02  ~  02T}lS02) 

=  <  -V20S0  -  w2(y2,t)l3C(3  -  W2(y2,t)S0  ~  0i(lxS0x  +  wx(li,t)C0x)  -  S0xwx(lx,t) 
J/2 0C0  —  W2(y2,t)PS(3  +  w2(y2,t)C(3  +  0\{l\C0x  —  wx(lx,t)S0x )  +  C0xwx(lx,  t) 
where  ijx  =  r}x(lx,t )  .  Thus, 


T\ink2  =\JQ  P(V2)A2(y*)  (t?2  •  ^2)  dV*  +  \jQ  J(y^  tfliy*,  0  •  7^2,  0)  <^2 


Finally,  the  expression  for  the  kinetic  energy  due  to  the  motion  of  the  payload 
follows  the  example  set  in  the  development  of  model  TTFEL,  although  in  the  present 
case  it  is  emphasized  that  the  rotation  matrices  include  the  effects  of  first  link  lateral 
flexure. 


In  other  words,  for  a  properly  grasped  payload 

T%L  =  R°xre  X  +  R°2?'2 
1 1°VL  =  Rfc  1  +  R°je  1  +  R%re  2  +  R°2  r%2 

^payfoad  =  ^MpLV$L  •  V°vL  +  i/w^(/2,<)  •  7^2,  <)  +  ^*3  t)/dy2dt)  2 

Tpayload  =  \mpLv°pL  .  ^  +  ±7* d2(0A2(/2)  +  ^43i2(<)^V 

And  for  an  eccentrically  grasped  payload 


=  fl°rel  +  R\rfX  +  R°2fe2  +  R IK2  +  R& 


T payload  —  2  MpLvpL  *  VpL 

With  the  kinetic  energy  expressions  determined,  the  complete  potential  energy 
levels  must  now  be  evaluated  in  order  to  form  each  system’s  Lagrangian.  The  potential 
energy  due  to  gravity  remains  virtually  unchanged  from  the  expression  shown  in  model 
TTEL.  However,  the  elastic  potential  energy  due  to  lateral  link  flexure  must  now  be 
accounted  for  as  well  as  the  elastic  potential  energy  due  to  link  torsion  in  both  models 
TTFEL  and  TFTFEL. 

Specifically,  as  a  result  of  second  link  flexure  in  both  models 

V/to .imu  =  \J0  Er(yi) 

W»«  =  5  /'■  EI(y,)  f)  6,-(0<(w)  £  h(t)4(yi)dy2 

L  °  j= 1  Jt=l 

Vflex.linki  «  |^/62(f)  jT*  «(y2))2rfy2 

assuming  uniform  links.  Also,  as  a  result  of  the  lateral  first  link  flexure  included  in 
model  TFTFEL,  the  following  elastic  potential  energy  expression  is  obtained 

VflexMnki  «  ^EIq2(t)  (V’i(yi))2  dyx 
also  assuming  a  uniform  first  link. 

Therefore,  the  total  elastic  potential  energy  for  model  TTFEL  is 


Vela.uc  =  l~EIb2(t)  {t"{yi))2  dy 2 


-GJA\t)j\T'M?dy, 
±GJa\t)  £  (Kb,))1  d„ 


and  the  total  elastic  potential  energy  for  model  TFTFEL  is 


=  \EIy‘{t)  £  MMfdy , 
+^EIb\t)£(t';(y2))2dy2 

+±GJA,(t)jfV'1(»i)),.fr, 

+  ^GJa1(t)£(Xl(y2)fdy2 


Since  the  kinetic  and  potential  energy  levels  have  been  completely  expressed  as  a 
function  of  generalized  coordinates  with  respect  to  an  inertial  frame  of  reference,  the 
complete  Lagrangian  for  each  model  is 


LtTFEL  —  Tnnif  i  -(-  T(,'nJt2  d"  -Fpoy/ood  ^ elastic  ^gravity 


L TFTFEL  —  T[{nk\  ■+■  Tlink 2  d"  Tpayload  Velaatic  ^gravity 


The  derivation  of  the  set  of  governing  differential  equations  of  motion  for  both 
models  is  now  possible.  For  model  TTFEL,  where  there  axe  five  degrees  of  freedom, 
the  following  expressions  are  applied  to  the  system  Lagrangian  Lttfel 


d/dt{dL/d6i}  -  dL/dO\  =  Tx 
d/dt  {dL/i 902 }  -  dL/de 2  =  T2 
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d/dt  [dL/d Ai}  -  dL/dAx  =  0 
d/dt  {dL/d e*!}  -  ai/ao!  =  0 
d/dt  {dL/d'h}  -  dL/dh  =  0 


An  abbreviated  listing  of  the  five  resulting  coupled,  second  order,  nonlinear  dif¬ 
ferential  equations  is  shown  below.  Note  that  the  equations  may  be  obtained  in  their 
full  form  by  referring  to  Appendix  B. 
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For  model  TFTFEL,  the  application  of  the  following  relationships  to  the  total  sys¬ 
tem  Lagrangian  Ltftfel  will  yield  the  complete  set  of  equations  of  motion  governing 
this  six  degree  of  freedom  problem. 


d/dt{dL/d0i}  -  dL/dOi  =  Tx 

d/dt  {dL/d62}  -  dL/d02  =  T2 
d/dt  {dL/dkx}  -  dL/d\x  =  0 


d/dt  {dL/dai}  -  dL/dai  =  0 


d/dt  {dL/dqi}  -  dL/dqi  =  0 
d/dt{dL/db1}-dL/dbi  =  0 


As  before,  an  abbreviated  listing  of  these  equations  is  shown  below,  and  the  full 
listing  may  be  obtained  by  referring  to  Appendix  B. 
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Chapter  3 


Control 


The  basic  objective  of  a  manipulator  control  scheme  is  to  move  the  robot  arm  from 
an  initial  position  to  a  desired  final  position  and  configuration  in  an  alloted  period 
of  time.  Once  this  is  achieved,  another  control  scheme  is  usually  utilized  to  coordi¬ 
nate  the  movement  of  the  manipulator’s  end-effector  with  the  environment.  In  other 
words,  robot  arm  control  as  a  category  includes  gross  motion  control  which  moves 
the  arm  to  the  vicinity  of  some  desired  fined  position  and  orientation,  and  fine  motion 
control  which  permits  the  arm  to  interact  dynamically  with  the  object  of  concern. 
The  focus  here  is  on  gross  motion  control,  which  can  be  classified  into  three  groups: 
joint  motion  control,  resolved  motion  control  (Cartesian  space),  and  adaptive  con¬ 
trols  [6].  Under  the  heading  of  joint  motion  control  fall  such  techniques  as  individual 
joint  servomechanism  control  (IJC),  variable  structure  control,  nonlinear  feedback, 
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and  feedforward  control,  among  others.  Resolved  motion  control  includes  position, 
velocity,  and  acceleration  control  methods  wherein  the  desired  trajectory  of  the  ma¬ 
nipulator  is  translated  from  Cartesian  world  coordinates  to  joint  coordinates  through 
the  governing  Jacobian  matrix.  Adaptive  control  techniques  rely  on  altering  feedback 
signals  on  the  basis  of  a  comparison  of  the  observed  performance  of  the  system  to  the 
performance  of  an  idealized  model. 


These  three  categories  include  many  more  control  techniques  and  variations  of 
control  schemes  than  is  listed  here.  Even  so,  the  individual  joint  control  method  (IJC) 
is  still  commonly  applied.  In  the  IJC  approach,  the  motors  at  each  joint  are  treated  as 
independently  functioning  servos.  Thus,  this  control  method  completely  ignores  the 
arm’s  nonlinear  dynamics  -  which  include  the  effects  of  Coriolis  and  centripetal  forces. 
Yet,  since  these  effects  tend  to  be  primarily  velocity  dependent,  the  IJC  approach  will 
work  fairly  well  as  long  as  the  robot  arm  is  not  required  to  move  at  high  speeds. 


In  this  study,  the  IJC  approach  was  first  applied  to  the  rigid  two  link  model  (Model 
RR)  in  the  form  of  proportional  plus  tachometric  feedback  positional  controllers  at 
each  joint  (see  fig.  10). 


Note  that  the  desired  angular  tragectory  0<*(t)  was  based  upon  either  a  “bang- 
bang”  or  a  ramped  motor  acceleration/decceleration  profile  (see  figs.  10.1  &  10.2). 


era  mP(t)  =  at3/(3tf)  -I-  ^(0)  0  <t<  t}!  2 
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Fig.  10  Joint-Motor  Servocontroller 


Or  =  G  {f2  -  t3/(3</)  -ttj/ 2  +  t}/l2}  +  0(0)  t]/ 2  <t<t, 

0bb  =  at2/ 2  +  0(0)  0  <  t  <  t}/2 

6bb  -  at  }t-  at2/ 2  -  at  J/4  +  0(0)  tf/2<t<tf 

. . .  where  a  is  the  maximum  motor  acceleration,  f  /  represents  the  target  time,  and 
0(0)  is  the  initial  joint  angle  measure.  Also,  first  estimates  of  the  gain  settings  I<p  and 
Kv  were  evaluated  assuming  a  desired  critically  damped  linear  system  response  ( thus 
placing  a  double  pole  at  a  position  of  -P  on  the  negative  real  axis  of  the  system’s  root 
locus  plot).  Better  gain  estimates  were  subsequently  found  through  trial  and  error 
runs  of  Model  RR  (  higher  gain  levels  were  required  for  heavier  payloads  ).  Also, 
values  of  motor  resistance,  rotor  inertia,  maximum  motor  acceleration  and  torque, 
etc.,  were  taken  from  manufacturerer’s  specifications  (Kollmorgan  Co.). 

In  an  effort  to  maximize  each  joint  angle’s  acceleration  through  proper  gearing, 


gear  ratios  N  were  evaluated  in  the  following  manner: 


Jt  =  Jm  +  JL 


Tgen  =  (Jm  +  JL/N2)6n 


which  ignores  the  adverse  effects  of  friction  or  the  influence  of  gravity. 


Qm  =  Tgen/  Jj 


h  =  em/N 


Maximizing  9i  with  respect  to  N 


d0L 

dN 


=  0 


-Taen(Jm  -  JJN) 
(NJm  +  Jl/NY 

N  =  y/JLf  Jm 


Finally,  it  was  assumed  that  no  lag  existed  in  the  feedback  loops. 


Once  it  was  determined  that  the  IJC  control  scheme  could  effectively  govern  the 
movement  of  the  rigid  two  link  model,  it  was  applied  to  each  of  the  flexible- link  models 
in  an  effort  to  examine  the  limitations  imposed  by  the  link  vibrations. 


Chapter  4 

Numerical  Techniques 

The  development  of  the  analytic  form  of  each  system  model  was  a  slow  and  extremely 
cumbersome  task  -  given  all  of  the  hundreds  of  terms  involved  in  each  of  the  equations 
of  motion.  Hence,  the  algebraic  symbolic  manipulation  language  MACSYMA  was 
employed  to  some  extent  to  assist  in  the  manipulations  of  each  system’s  Lagrangian. 
Thereafter,  all  models  were  translated  into  FORTRAN  algorithms  and  run  on  a  VAX 
8650  computer. 

The  objective  of  each  program  was  to  obtain  the  simultaneous  solutions  to  each 
model’s  set  of  governing  equations  of  motion.  Note  that  in  all  cases,  the  set  of 
differential  equations  was  second  order,  nonlinear,  and  fully  coupled.  Moreover,  due 
to  the  large  disparity  between  the  high  natural  frequencies  of  structural  link  vibrations 


and  the  low  frequency  of  each  joint  angle  trajectory,  the  family  of  equations  for  each 
flexible-link  model  was  also  very  “stiff.”  As  a  result,  the  simultaneous  numerical 
integration  of  these  equations  proved  to  be  difficult  and  very  time  consuming  due 
to  the  extremely  small  step  sizes  required  by  standard  Runga-Kutta  techniques.  As 
a  matter  of  fact,  the  Runga-Kutta  method  is  not  well  suited  for  this  problem  at 
all.  However,  modern  predictor-corrector  techniques  which  have  been  specifically 
designed  for  stiff  systems  of  equations  are  available.  One  such  technique,  which 
was  developed  by  Gear  [11]  and  considered  to  be  the  state-of-the-art  in  1975,  is 
available  in  the  IMSL  libraries  of  most  main-frame  computers.  Using  this  algorithm, 
the  simultaneous  integration  of  each  model’s  set  of  differential  equations  was  able  to 
proceed  much  more  quickly,  depending  on  the  accuracy  of  the  results  desired.  This 
technique  was  employed  in  all  of  the  flexible-link  simulations  and  some  of  the  results 
were  later  compared  with  the  solutions  produced  using  a  5th  —  6i/l  order  Runga-Kutta 


technique. 


tip — rw — rrr — ttt — tt? — rn — 


I 


* 


I 


f 


p. 


B 


Chapter  5 


Results  and  Discussion 


For  all  models,  the  same  basic  system  configuration  was  used.  Both  the  first  and 
second  links  were  modelled  as  slender  Euler-Bernoulli  beams  one  meter  in  length  and 
consisting  of  the  aluminum  alloy  2014-T6  (properties  found  in  Mark’s  M.E.  Hand¬ 
book).  The  motors  that  delivered  power  to  each  revolute  joint  were  modelled  after 
the  Kollmorgan  model  2045  servo,  which  is  rated  at  a  continous  torque  output  of 
2.18N  —  M  and  a  peak  torque  output  of  9.09  N  —  M.  Furthermore,  the  derivation 
of  the  gear  ratios,  as  shown  earlier,  yielded  optimal  overall  values  of  400/1  for  the 
base  revolute  joint,  and  175/1  for  the  second  revolute  joint.  Also,  the  payloads  used 
ranged  from  1%  to  14%,  compared  to  a  system  mass  of  roughly  26 kg  (including  the 
mass  of  the  motors). 
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The  optimal  control  scheme  for  the  flexible  models  proved  to  be  the  combination 
of  the  IJC  strategy  and  a  ramped  motor  acceleration/decceleration  profile.  A  “bang- 
bang”  motor  acceleration  profile  worked  well  with  the  rigid-link  Model  RR,  however 
it  was  avoided  with  the  flexible-link  models  because  it  was  found  that  a  step  acceler¬ 
ation  input  would  induce  very  high  frequency  structural  vibrations  quite  early  in  the 
motion.  This  result,  coupled  with  the  system’s  nonlinear  effects  proved  to  make  the 
numerical  integration  of  the  governing  equations  over  the  course  of  the  manipulator’s 
full  trajectory  far  too  time  consuming  even  when  Gear’s  method  was  used  .  Also,  in 
order  to  exclude  the  effects  of  alternating  positive  and  negative  gravitational  influ¬ 
ences,  and  to  avoid  singularity  positions,  it  was  decided  to  restrict  the  manipulator 
to  vertical  motion  with  positive  joint  angle  measures. 

Generally  speaking,  the  focus  of  these  case  studies  has  been  to  observe  and  com¬ 
pare  the  behavior  of  the  two  link  manipulator  as  simulated  by  each  flexible-link  model 
to  the  behavior  of  an  assumed  rigid-link  manipulator  as  simulated  by  Model  RR,  and 
to  note  any  general  trends  or  effects  resulting  from  the  torsional  and/or  lateral  flexibil¬ 
ity  of  each  link.  Moreover,  it  was  expected  that  these  studies  would  clearly  illustrate 
the  influences  of  eccentric  load  induced  bending-torsion  link  vibrations,  and  thus  per¬ 
mit  a  comparison  between  the  effects  of  this  phenomena  and  the  effects  of  single-plane 
link  bending. 

Before  beginning  the  case  studies,  the  rigid-link  model  was  validated  since  the 
equations  governing  this  case  formed  the  core  of  the  gross  robot  arm  motion  simulated 


in  all  of  the  subsequent  models.  The  derived  equations  of  motion  for  model  RR  were 
compared  to  the  same  equations  as  listed  in  Asada[l]  and  Fu[6].  Additionally,  a 
“fall”  test  was  conducted  which  consisted  of  letting  the  manipulator  drop  loose  from 
an  extended  horizontal  position  with  no  applied  motor  torques,  and  then  verifying 
that  it’s  ensuing  motion  due  to  the  influence  of  gravity  immitated  the  motion  of  a 
planar  double  pendulum.  Each  of  the  flexible-link  models  were  also  tested  by  ensuring 
that  the  rigid-link  equations  of  motion  would  remain  in  their  entirety  after  all  of  the 
flexibility  variables  were  removed  from  each  model’s  set  of  governing  equations  of 
motion.  Finally,  each  flexible-  link  model  was  subject  to  the  same  “fall  test”  as 
previously  described. 

Once  these  tests  were  satisfactory  completed,  model  RR  was  tasked  to  move  from 
an  initial  configuration  of  15°  at  0X  and  15°  at  02  ,  to  a  target  configuration  of  45°  at  0X 
and  45°  at  02  in  a  period  of  one  second,  while  carrying  a  payload  with  its  end-effector 
(see  fig.  11).  The  resulting  transient  response  of  each  joint  angle  trajectory  was  then 
saved  for  comparison  to  the  same  joint  angle  trajectories  produced  by  the  flexible  link 
models. 

Since  all  considered  flexibility  effects  were  included  in  model  TFTFEL,  and  the 
remaining  flexible-link  models  may  be  derived  from  it,  the  case  studies  concentrated 
on  the  simulations  produced  by  this  model. 

Perhaps  the  first  observed  consequence  of  the  link  flexibility  while  simulating  the 
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described  vertical  motion,  was  the  reactive  upward-displacement  of  the  end  of  link 
one  due  to  the  torque  applied  by  the  second  joint  motor,  and  the  lack  of  motion  of 
link  two.  Considering  the  system’s  configuration,  this  result  can  be  explained  since 
the  inertial  resistance  to  movement  presented  by  the  combination  of  the  second  link 
and  payload  was  greater  than  the  first  link’s  resistance  to  elastic  flexure.  Reducing 
the  length  of  the  second  link  and  lowering  the  mass  of  the  payloads  would  certainly 
remedy  this  problem,  but  would  also  severely  limit  the  case  studies  planned.  Also, 
since  most  robot  arm’s  in  use  today  axe  configured  with  a  longer  second  link,  it  was 
decided  to  shorten-up  and  strengthen  link  one  instead. 


With  a  non-eccentric  payload  gripped  at  the  end  of  link  two,  the  vertical  motion  of 
the  manipulator  towards  the  target  configuration  induced  a  normal  downward  planar 
flexure  of  link  two,  as  expected,  and  a  slight  upward  displacement  of  the  end  of  link 
one  (  which  was  on  the  order  of  hundredths  of  a  millimeter  -  see  fig.  12).  Moreover, 
once  the  target  configuration  was  reached  the  end  of  the  second  link  would  begin  to 
vibrate  about  its  resting  position,  eventually  damping  out  (see  fig.  13).  It  is  important 
to  consider  this  behavior  because  the  ensuing  fine-motion  control  of  an  end-effector 
mounted  at  the  tip  of  link  two  would  be  affected  by  this  vibration.  Overall,  though, 
no  particularly  adverse  influences  upon  the  joint  angle  trajectories  were  noted  in  this 


In  contrast,  the  joint  angle  trajectories  and  the  resulting  gross  motion  control  of 
the  two-link  manipulator  was  significantly  affected  by  the  bending-torsion  vibrations 
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that  developed  in  each  link  as  a  result  of  the  robot  arm’s  efforts  to  move  an  eccen¬ 
trically  gripped  payload.  (Note  that  these  vibrations  move  the  case  at  hand  from  a 
planar  to  a  three  dimensional  problem).  Generally,  the  resulting  transient  response 
of  each  joint  angle  trajectory  exhibited  increases  in  maximum  peak  overshoot,  and 
increases  in  settling  time.  There  was  also  a  noticeable,  increased  lag  in  the  response 
of  the  second  joint  angle  02  .  These  conclusions  were  drawn  after  examining  the 
performance  of  the  two  link  manipulator  while  moving  from  the  described  initial  con¬ 
figuration  to  the  final  vertical  configuration  in  a  period  of  one  second  while  carrying 
eccentrically  positioned  loads  (  e  =  8cm  )  ranging  in  size  from  1%  to  14 kg  . 

Referring  to  the  case  where  the  eccentric  load  is  1kg  (figs.  14,14.1,  14.2),  which  is 
3.8  percent  of  the  system’s  total  mass,  note  the  increased  lag  and  hesitation  of  each 
joint  angle  history.  Furthermore,  an  increase  in  peak  overshoot  and  a  slight  increase 
in  settling  time  is  evident.  Referring  to  the  joint  angle  histories  for  the  case  of  an 


eccentric  3 kg  payload  (figs.  15,15.1,15.2),  the  same  behavior  is  noticed.  In  fact,  all 
of  the  loads  considered  produced  these  effects  on  the  joint  angle  trajectories,  and  the 
severity  of  these  effects  was  generally  noted  to  increase  in  proportion  to  the  size  of 
the  eccentric  load  (see  figs.  18-21). 

It  is  suspected  that  a  reason  for  these  disturbances  of  the  transient  response  of 
each  joint  angle  trajectory  is  the  somewhat  higher  amplitude  and  frequency  of  the 
structural  bending-torsion  vibrations  compared  to  the  amplitude  and  frequency  of  the 
planar  flexural  vibrations,  both  of  which  are  observed  to  occur  when  the  manipulator 
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is  closing  in  on  its  target  configuration.  It  is  at  this  time,  when  the  gross  motion  is 
virtually  complete  and  the  torques  are  small  that  these  vibrations  have  a  significant 
influence  upon  the  joint  angle  time  histories.  Consider  the  plots  of  the  end-effector 
lateral  vibrations  for  each  case  compared  to  the  lateral  planar-vibrations  that  occur 
when  the  load  is  not  held  eccentrically.  The  increased  amplitude  and  frequency  of 
the  vibrations  that  occur  is  depicted  in  many  of  the  plots,  indicating  that  the  amount 
of  time  needed  until  they  settled  increased.  Consider  figs.  17.1,17.2,  and  17.3,  which 
pertain  to  the  case  when  a  lAkg  payload  -  which  is  more  than  50  percent  of  the  system 
mass  -  is  held  eccentrically.  Over  ten  seconds  passes  before  the  system  settles  and  the 
end-effector  vibrations  cease.  Even  when  the  eccentric  load  is  small  many  seconds 
pass  before  these  vibrations  settle  down  (see  fig.  22).  We  must  consider  the  average 
dynamic  error  of  the  end-effector  due  to  these  vibrations  and  note  that  this  error 
is  generally  larger  when  produced  by  an  eccentric  payload  (see  fig.  23).  Hence,  the 
objective  of  high  end-effector  positional  accuracy  and  its  successful  fine- motion  control 
certainly  appears  to  be  difficult  to  attain  in  light  of  this  phenomena.  In  fact,  the 
objective  of  a  reliable,  and  immediately  stable  response  from  the  robot  manipulator 
as  a  whole  is  not  realistic  in  the  presence  of  these  high  frequency  structural  vibrations. 
This  difficulty  is  especially  likely  since  most  control  schemes  ignore  the  effects  of  link 
elasticity. 

In  order  to  reduce  the  detrimental  effects  of  these  vibrations  and  improve  the  accu¬ 
racy  of  the  manipulator,  it  was  proposed  to  introduce  additional  structural  damping 
into  the  system.  In  practise,  this  could  be  accomplished  with  passive  damping  tech- 


niques  such  as  coating  the  aluminum  links  with  a  polymer  jacket,  inserting  in  the 
hollow  links  removeable  rubber  baffles  which  would  still  permit  conduits  to  pass,  or 
utilizing  layered  composite  materials  to  construct  the  links  themselves.  Note  that  at¬ 
tempting  to  diminish  the  high  frequency  vibrations  through  damping  methods  offers 
a  far  cheaper  and  easier  first  alternative  to  the  use  of  sophisticated  control  techniques. 


Thus,  simulated  positive  damping  was  added  to  the  differential  equations  gov¬ 
erning  the  vibrations  in  both  links  one  and  two.  Results  from  subsequent  simula¬ 
tions  indicated  a  definite  improvement  in  the  transient  responses  of  each  joint  angle 
trajectory,  and  a  reduction  in  the  severity  of  the  bending-torsion  vibrations  at  the 
end-effector  (see  figs.  24  25).  Just  how  much  damping  to  introduce  was  also  eval¬ 

uated.  Referring  to  fig.  26,  it  is  evident  that  the  damping  ratio  required  increased  as 
a  function  of  the  size  of  the  payload. 


Since  they  are  a  function  of  the  joint  angle  velocities,  Coriolis  and  centripetal 
effects  are  often  justifiably  ignored  in  the  real-time  control  schemes  of  robot  manipu¬ 
lators  in  order  to  speed-up  the  rate  of  the  numerical  solution  to  the  system’s  equations 
of  motion.  However,  the  arm  is  then  restricted  to  slow  speeds  of  movement,  which 
may  not  be  desireable  in  many  applications.  An  advantage  provided  in  simulation 
studies  is  that  prior  knowledge  of  the  complete  closed  form  equations  of  motion  en¬ 
ables  one  to  readily  identify  these  terms,  and  experiment  with  compensation  methods. 
Thus,  some  brief  attempts  were  also  made  to  account  for  the  system’s  Coriolis  and 
centripetal  effects  with  nonlinear  feedback  control  methods.  This  is  accomplished  by 
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coupling  the  separate  joint  servocontrollers  with  velocity  feedback  paths,  and  treat¬ 
ing  the  Coriolis  and  centripetal  effects  as  disturbance  torques  along  with  the  gravity 
torques  in  each  joint’s  control  loop  (see  fig.  27).  It  was  not  necessary  to  account 
for  all  of  the  Coriolis  and  centripetal  terms  appearing  in  the  system’s  equations  of 
motion  before  slight  improvements  in  performance  were  observed.  Specifically,  the 
transient  responses  of  each  jomt  angle  trajectory  indicated  a  drop  in  peak  overshoot 
and  settling  time,  and  slightly  quicker  speeds  of  movement  were  permitted.  It  should 
also  be  mentioned  that  the  material  flexibility  led  to  the  presence  of  cross-product 
terms  between  joint  velocities  and  material  displacement  velocities  in  the  equations 
of  motion;  indeed,  the  system  was  fully  coupled,  ^hese  terms  mathematically  de¬ 
scribe  the  form  of  some  of  the  peculiarities  and  reverse  -effects  caused  by  the  material 
elasticity.  No  attempts  were  made  to  compensate  for  these  phenomena,  however,  this 
could  be  attempted  after  examining  the  equations  of  motion  as  listed  in  Appendix  B. 
One  suggestion,  as  a  matter  of  fact,  is  to  feed  forward  the  flexibility  terms  (i.e.  the 
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Chapter  6 

Summary  and  Conclusions 

Current  trends  and  research  efforts  in  the  field  of  robotics  indicate  a  definite  desire 
to  obtain  a  greater  understanding  of  the  consequences  of  material  flexibility.  An 
increased  awareness  of  the  effects  of  joint  elasticity  and  link  displacements  permits  the 
development  of  sophisticated  manipulator  control  schemes  and  other  techniques  aimed 
at  minimizing  the  dynamic  and  static  errors  inevitably  seen  in  the  manipulator’s 
trajectory  and  end-effector  positioning  as  a  result  of  link  flexure  and  vibration.  In  this 
light,  much  noteworthy  work  has  been  accomplished  in  the  U.S.  and  abroad.  Single¬ 
link  robot  models  and  two-link  robot  models  with  a  variety  of  joints  and  degrees  of 
material  flexibility  have  been  derived  using  many  methods.  Resulting  suggestions  for 
compensation  are  many,  and  more  are  being  published  yearly. 


It  has  been  the  intention  of  this  study  to  also  focus  on  the  example  of  a  two- 
link  revolute-joint  robot  manipulator  and  to  develop  models  to  simulate  its  motion 
when  each  link  is  permitted  to  elastically  deform.  Specifically,  five  system  models 
are  developed,  the  last  of  which  allows  each  of  the  manipulator  links  to  displace  in 
torsion  and  in  flexure  -  yielding  a  total  of  six  degrees  freedom.  The  crux  of  each  of 
these  models  is  a  set  of  coupled  governing  differential  equations  of  motion,  which  are 
second  order  and  nonlinear  and  have  been  derived  using  the  Lagrange- Euler  technique 
and  a  proper  kinematic  description  of  each  system.  Material  displacements  have  been 
represented  through  the  method  of  assumed  modes  in  a  single-mode  approximation. 
Moreover,  proportional  plus  tachometric  feedback  positional  control  policies  axe  used 
to  operate  the  servos  which  provide  power  to  each  system  at  their  revolute  joints. 
Finally,  the  models  are  all  run  on  a  VAX  8650  digital  computer  wherein  quick  vertical 
motion  is  simulated  while  the  manipulator  holds  a  payload  at  its  end-effector. 

Unlike  any  of  the  aforementioned  articles,  the  models  developed  in  this  study  also 
consider  the  effects  of  carrying  an  inertially  asymmetric  payload.  In  fact,  Model  TFT- 
FEL  simulates  the  elasto-dynamic  behavior  of  the  manipulator  seen  as  a  result  of  the 
coupled  bending-torsion  vibrations  in  each  link  that  are  driven  by  the  manipulator’s 
movement  while  carrying  such  a  load.  Case  studies  are  conducted  to  determine  the 
detrimental  effects  of  this  behavior  on  the  joint  angle  trajectories  of  the  manipulator. 
Specifically,  it  is  seen  that  the  transient  response  of  each  joint  angle  trajectory  ex¬ 
hibits  rises  in  maximum  peak  overshoot  and  settling  time,  and  a  hesitation  in  response 
-  especially  in  the  second  joint  angles.  Moreover,  lateral  vibrations  are  observed  at 


the  manipulator’s  end-effector,  and  it  is  readily  apparent  that  the  average  amplitude 
and  frequency  of  these  displacements  as  caused  by  the  coupled  bending-torsion  of  the 


links  were  greater  them  the  amplitude  and  frequency  of  the  single  plane  displacements 
as  driven  by  a  properly  positioned  payload.  Hence,  more  time  would  be  necesary  to 


settle  this  motion  to  allow  for  accurate  end-effector  fine  motion  control.  It  has  been 
asserted  that  since  most  control  algorithms  ignore  this  phenomena  completely,  then 
the  objective  of  a  smooth,  reliable  and  accurate  manipulator  reponse  as  a  whole  is 
indeed  questionable.  Artificial  passive  damping  techniques  used  to  eliminate  or  at 
least  reduce  the  severity  of  these  high-frequency  vibrations  were  also  attempted,  and 
resulted  in  marked  improvements  in  the  two  joint  angle  trajectories.  It  was  found 
that  by  increasing  the  damping  ratio  in  the  equations  governing  torsional  and  lateral 
elastic  link  displacements,  the  detrimental  effects  of  the  bending-  torsion  vibrations 
could  be  almost  completely  subdued,  and  the  end-effector  displacements  would  follow 
as  the  planar  vibrations  had. 

An  additional  aspect  of  this  study  is  the  inclusion  of  the  complete  closed-form 
governing  equations  of  motion.  Having  the  full  listing  of  the  differential  equations 
for  Model  TFTFEL  enables  one  to  pose  studies  of  the  effectiveness  of  various  control 
policies  such  as  FFC  (  the  feed-forward  of  flexibility  coefficients  ).  Although  time 
did  not  permit  full  studies  of  this  kind  to  be  carried  out,  some  attempts  were  made 
with  nonlinear  feedback  techniques  with  motor  speed  in  order  to  compensate  for  the 
system’s  centripetal  and  Coriolis  effects.  Results  indicated  an  improvement  in  the 
accuracy  of  the  transient  responses  of  each  joint  angle  trajectory  with  reductions  in 
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target  position  overshoot  and  settling  times. 


Overall,  this  study  has  been  conducted  for  the  purpose  of  deriving  models  which 
tire  intended  to  be  used  as  tools  to  aid  further  investigation  into  the  effects  of  elastic 
link  displacements  and  how  to  compensate  for  this  phenomena.  Although  the  method 
chosen  to  derive  the  governing  equations  for  each  case  did  not  lead  to  the  most 
computationally  efficient  models,  the  resulting  closed-form  equations  do  have  the 
advantage  of  being  explicitly  a  function  of  the  manipulator’s  physical  characteristics, 
and  therefore,  much  can  be  learned  from  them.  Much  time  was  also  expended  in  an 
effort  to  make  all  of  the  steps  in  the  derivation  as  clear  as  possible  and  it  is  hoped  that 
this  will  also  aid  further  studies  of  this  kind.  Finally,  it  should  be  mentioned  that 
although  the  packaged  numerical  technique  used  for  the  simultaneous  integration 
of  the  equations  of  motion  in  each  model  is  highly  advanced  and  fast  compared 
to  standard  Runga-Kutta  methods  (  which  are  not  suited  for  the  stiff  systems  of 
equations  seen  in  these  flexible-link  models  ),  it  still  has  its  limitations  and  tends 
to  be  very  sensitive  to  its  many  inputs.  As  a  result,  the  extent  of  the  variations  in 
manipulator  speeds,  trajectories,  and  payload  sizes  that  could  be  tried  was  somewhat 
limited.  Perhaps  efforts  in  nondimensionalization  with  respect  to  material  stiffness 
El  would  increase  the  bandwidth  of  possibilities  in  the  study  of  the  manipulator’s 


motion. 
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Chapter  7 


Appendix  A 
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The  boundary  value  problem  for  a  cantilever  bar  in  torsion  is  governed  by  the  following 
equation  for  its  free  vibration 

d_  [  d0OM)l  _  rd29(x,t) 

dx  [  dx  l  ~  &t 2 

(. . .  assuming  a  uniform  bar).  If  a  payload  is  fixed  to  its  end,  we  have  the  following  boundary 
conditions: 


0((U)  =  0 


=  _IpL  d%i) 


dx  *vu  dx2 

This  problem  is  solved  through  separation  of  variables,  and  special  attention  is  payed  to 
the  fact  that  the  system  eigenvalue  also  appears  in  the  second  boundary  condition.  The 
resulting  trancendental  frequency  equation  is 


„  II  1 
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and  the  natural  modes  are  given  by: 


4>t{x)  =  Ar  sin/?rz  r=  1,2... 

In  our  particular  case,  the  problem  is  somewhat  extended  since  Ipl  =  Ipl{9 2),  where  82  = 
02(O  is  the  manipulator’s  second  joint  angle.  Therefore,  Ipl  =  /pl(0>  an<*  which  is  found 
iteratively  using  the  transcendental  frequency  equation,  is  now 

p  =  m)  =  m 

Therefore,  the  expression  for  the  solution  to  the  torsion  problem  using  a  single  mode  ap¬ 
proximation 

9(x,t)  =  q(t)<j>(x) 

. . .  becomes 

9(x,t)  =  q(t)A  sin  (3(t  )x 

If  this  is  the  case,  then  the  complete  expression  for  the  defined  free  vibration  problem  would 
become 

~P2GJq  sin  /3z  =  Iq  sin  fix  +  2 Iq/3  cos  f3x 
+Iq(3  cos  0x  -  Iq/32  sin  / 3x 

Multiplying  by  sin  /3x  and  integrating  both  sides  of  the  equation  with  respect  to  x  yields 

rl  rl 

~(32GJq  J  sin2  f3xdx  =  Iq  J  sin2  f3xdx 

+2 Iq$  f  sin  (3x  cos  j3xdx 
Jo 

+Iq(3  f  sin/3x  cos  f3xdx  -  Iqf)2  f  sin 2  (3xdx 
Jo  Jo 

Since  the  /q  sin2  (3 xdx  &  /q  sin  (3x  cos  (3xdx  are  of  the  order  l  at  most  (  where  l  is  the  length 
of  the  bar  ),  we  can  neglect  the  spatial  dependence  on  x 
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Instead  of  carrying  the  full  extent  of  the  details  surrounding  this  time  dependent  boundary 
condition  to  the  simulation,  it  was  decided  to  make  the  simplifying  assumption  that  0 
and  0  and  the  three  terms  from  the  above  equation  involving  these  terms  were  small  in 
comparison  to  q.  Note  that  the  algorithm  used  in  the  FORTRAN  code  does  adjust  0  for 
each  iteration,  but  the  full  consequences  of  its  time  dependence  are  neglected.  This  is  based 
on  the  following  reasoning: 


q  =  u2q  >  {  ql 3 


kP 


qP2 


or  equivalently 


w2  »  < 


qp/q 

P 

P2 


If  this  inequality  is  satisfied,  then  the  following  relationship  stands  as  a  close  estimate  to 
the  free  vibration  equation: 


- 02GJqsm0x  =  Iu1q$m0x 


.  and 


-02GJ 


=  u;2 


Hence,  for  this  assumption  to  be  valid,  we  require  that  the  following  must  be  true: 


-P2GJ  , 

w  =  \/ - ; -  >  P 


A  permitted  assumption  is  that  0  is  small.  Therefore,  from  the  frequency  equation  we 
can  obtain  an  estimate  for  0  in  the  following  manner  : 


*jL» 
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ft 
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ft 
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let  n  = 


n 

IpL 


tan  01  = 


131 


. . .  with  (3  small  we  have 


m2  =  ii 


therefore 


4  = 


A 

2/,/m 


If  we  consider  as  an  example  the  case  where  the  payload  is  1  kg  and  the  bar  is  lm 
in  length  and  configured  as  the  manipulator  links  were,  calculations  lead  to  the  following 
values: 


u2  «  3700 


u  «  61 


4  «  0.027 


. . .  and  indeed  u  »  4  •  Thus,  the  previous  approximation  is  justified.  A  similar  argument 
can  be  used  in  the  case  of  the  lateral  vibration  of  the  links. 


8 

e 


98 


&^as»a 


S5 


v 


v 


Chapter  8 

Appendix  B 

The  governing  set  of  equations  of  motion  for  each  separate  model  may  be  derived  from  the 
full  expression  of  the  equations  of  motion  for  the  six  -degree-of-freedom  model  TFTFEL  by 
removing  non-applicable  terms. 

Specifically,  for  model  TTFEL,  all  terms  involving  the  variables  representing  first  link 
lateral  vibration,  q(t)  and  should  be  removed  and  the  resulting  five  equations  of 


motion  will  result. 

Furthermore,  for  model  TTEL,  all  terms  involving  the  variables  that  represent  second 
link  lateral  vibration,  b(t)  and  t(y 2),  should  be  removed  as  well  thus  yielding  the  desired 


four  coupled  equations  of  motion. 


p 


& 

i 


Finally,  for  model  TT,  all  terms  involving  an  eccentrically  positioned  load  are  also 
removed,  and  for  model  RR,  only  the  rigid-link  terms  should  remain. 


8.1  Equations  for  Model  TFTFEL 
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The  full  form  of  the  equations  of  motion  for  the  six  degree  of  freedom  model  will  be  listed 
as  compactly  as  possible  by  defining  the  terms  that  appear  in  the  matrix  form  of  the  system 
as  shown  below. 


hi 

hi 

ha 

In 

hs 

hs 

01 

0iBn 

C11 

Ti 

hi 

I22 
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I74 

hs 

hs 

02 

O2B21 
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Ti 

hi 

I32 

I33 

I34 

I35 

I 36 

Ai 

+ 

A1B31 
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C31 

_ 

0 

hi 
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I44 
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0 
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In 
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In 

hs 

hs 

61 

bBsi 

C^61 
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VJ 


V 

V 

V 


„v 

*»k 

L' 


hi  —  Ai(Si  +  q2  V5)  +  A^/fS^  -I-  A2S2 

+  2A2S3[/1C(03  +  Ci)  +  ?^5(02  +  Ci)] 


+  2A3bV3[qipC(02  4-  Ci)  —  hS{d3  +  Ci )] 


a 


+  Mpl  { / f  +  2eAr/i5Ci  +  l\  +  2e(a\ -  1)/25C2} 


m 

_  s  V1 

*v  v  ■ 

i 


m 


+  2MpL[l1l2C(02  +  Ci)  +  S(0 2  +  Ci)(^290  —  / ibe)  +  eAr/2S02  ~  eliS(02  +  Ci  +  C2 )] 
A2S2  +  A2S3[l\C(02  +  Ci)  +  ii>S(02  +  Ci  )3 
+  A2bV3[q^C(02  +  Cl)  -  hS(02  +  Cl)] 

+  MpL  {l\  +  2e(aX  -  1)/2SC2  +  hhC(02  +  Ci)} 

+  MpL  {.?(02  +  Ci)(f2?V*  ~  libe)  +  eAI72S02  —  eliS(02  +  Ci  +  C2)} 

Mpier(aX  +  l)/j 

-  MpieT[l2C02  -  Ml2S02S(02  +C2)] 

MpLeX\T(aX  -  l)l2C02 

-  Mpi,eX  {(aA  -f  l)l2  +  ( aX  ■+■  \)liC(02  +  Ci  +  C2)} 

A1V4  +  A2I11PS4  +  A2S2'fr' 

+  A2S3rP'[hC{02  +  Ci)  +  qipS(0  2  +  Ci )] 

-  A2brPS(02  +  CiJV'a  +  A2rpC{02  +  Ci)S3 
+  A2bip'[qipC(02  +  Ci)  ~  hS(03  +  Ci )]^3 

+  Mpl  {tHh  +  eAr5Ci)  +  iP' (1 2  +  2«(aA  -  1)/25Cj)} 

+  Afp£V’,  {hhC(02  +  Ci)  +  S(0  2  +  Ci  )(^2?V’  —  hbt)  +  eAI72S02  —  e/iS(02  +  Ci  +  Ca) } 
+  P/fpL^P[hC(02  +  Ci)  +  —  1)S(#2  +  Ci  +  C2)] 

+  MpL^'llS<:ieAX(aX  +  l) 

A2l\C(02  +  Cl)^3  +  A2V2 

+  Mpl  {f(hC(02  +  Cl)  -  eArS02)  +  e(h  +  e(a X  -  1)5C2)} 
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A2/2M'iS{202)S2  +  A2b\r2C(202)V2 


-  MpLr[el2C02  -  eATl2S02S{02  +  CO] 

+  MpLT  {l/2S(202)llAT  +  eAr[S(02  +  C2)(<*A  -  l)S02/a  -  l2C62(a\  +  1  )C(02  +  Ca)]} 
I2  4  =  —Xl2e(aX  +  1  )Mpi 

hi  —  A2S2ip'  —  A2bipS{02  +  Ci)^3  4-  A2xl)C(62  +  COS3 
4-  Mpi  { l2  +  2e(aX  —  l)/2SC2Vv} 

+  MpL'P  {hC{02  +  (^i)  +  e(aX  —  1)S(02  +  Ci  +  C2)} 

I26  =  A2V2  +  MP£f(/2  +  e(aA  —  1)S(,2) 

+  MpLe'e(aX  -  1)/2S<2  -  MpLe\ri2S02€' 

I33  =  s7  +  A2r2s202s2  +  A2br2s(202)v2  +  sa 

+  MpLT3  {S202ll  +  2c2  +  S(202)/26e} 

+  2MpLY2  {el2S02AT  -  el2S02aXC(02  +  CO) 

Im  =  C02Si 

/35  =  -A/p£r^[Ar/25<?2  +  c(aA  +  l)] 

-  MpLTiP'l2e[C02  -  ATS02S(02  +  Ca)] 

Im  =  A2/2Ar25(2^2)V2  +  A2Ar2C2026Vi 

+  Mp£re[5(2tf2)/2Ar  -  eC02) 

I\*  = 

/«  =  eMptAV>'{AA(aA-  1)/2C02  -  (aA  +  l)/2} 

-  eMpiXip  [AT  +  (aA  +  1)C(02  +  Ci  +  Ca )] 

Ae  =  — «Ae(aA  +  l)AfP£ 

hi  =  A1V5  +  A2ip2Sa  +  A2ip'ip' 

+  2 A2W[C(02  +  Ci)^  -  bS(02  +  Ci)V3] 

+  Mpi  {ip2  +  tp'ip'[l2  +  2e(aA  —  l)/2S’Ca] } 

+  2 MPLipip'  {l2C{02  +  Ci)  +  e(aA  —  1)S(02  +  Ci  +  Cj)} 


+  2MpLV’V>'eArS<;i(aA  +  1) 

he  —  Ajtl>C(6j  +  £1)^3  +  Ajip'V2  +  MPLipeC(02  4-  Ci) 
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+  MpLtl>'e'  {e(c*A  -  1)/25C2  -  eAI72S02} 
he  =  A2Vi  4-  Mp£,  {f2  +  2«,eeSC2} 

Note  that  the  mass  matrix  is  symmetric,  therefore: 

hi  =  In 
hi  —  1 13 

hi  =  I14 

hi  =  he 


At  this  point,  the  other  terms  can  be  defined  as  well: 

4-  Cn  = 
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+betMPL  JaASCa  +  (aA  —  l)6e'j 

Ar2/2Mp£  \p2C{202)l2K  l2AS(202)/2  +  eA  {S(02  +  C2)(«A  -  1  )S92  -  C92{a A  +  1  )C(02  +  C2)}] 


+Ar/2eArMp£  J(^2  +  be')C(02  +  C2)(aA  —  l)S02  +  S(0 2  +  C2)dAS/?2  +  S(6 2  +  C2)(aA  —  1)C^2^2] 
+An2e\TMpL  \-C02a\C{O2  +  C2)  +  C03(aA  +  1  )S{02  +  C2)(^2  +  &O] 
—a\ta\l2MPL  +  be'  eaAl2Mpi,SC2 
+be'e(a\  —  l)l2be'Mpi 


m 

II 


-e\rhS92b('MpL 


— eAI72C02  02  be'MpL 


+  A29ibl\S(&2  +  Cl)^3 

—A20i(9i  +  62  +  qi>')  [— hS(02  +  Ci)  +  qipC(0 2  +  Ci)]  S3 
+A2b0iV3qipC(02  +  Ci)  +  A2qip0iS3S(02  +  Ci) 

+A2b9\(6\  +  02  +  qi> ')  [qi/>S(0 2  +  Ci)  +  hC(02  +  Ci )]  V3 
+A2AT2S(202)bbAVi 

+#i6e[/iS(02  +  Ci)  +  tkYCO^MpL  +  qbxptS(02  +  Ci  )Mpl 
-(AT)2MpLh  [ SO2C02I2  +  C(203)be  +  eC07 AT  -  eaAC(202  +  Ca)] 

—AbTtMpL  [C(202)l2AT  +  eS02  +  /2ArC(202)] 

-(0i  +  02  +  qV)Arel2MpL  [Ar5(20a  +  Ca)  +  S#a] 

-0i(0i  +O2  +  q^')MpL  [~S(02  +  Ci)hh  +  C(0,  +  Ci )(W  ~  h b()  +  eATl2C02  -  ehC(0a  +  Ci  +  Ca)] 
—qrl>{0\  +  02  +  qrl>')  [—  /2S(02  +  Ci)  +  e(aX  -  1)C(02  +  Ci  +  C2)]  Afpi 
+AqT^C02ATl2MpL 

-02AT2A  [C(2ffa)/|  +  el,  {S(207  +  Ca )(crA  -  1)  +  (oA  +  1)S(202  +  Ca)}]  MpL 
— dA02e(aA  —  l)ArS02/2AfP£,  +  dA(0i  +  02  +  qrp')eAT(aX  —  l)/2502Mpi 
+Mpi{0\  +  02  +  qrl>')b('  eAThC02  —  Mpiix'O  ie(oA  —  l)/iC(02  +  Ci  +  C2) 

— 0idAe(aA  +  l)liS(02  +  Ci  +  (2)  MpL 
+Mpi,g  [hC/3  —  eS(0  +  Ca)]  +  tnigCPh/2 

. . .  Also 

AB31  +  C31  = 

A26ArJ02C(202)V2 


-a2Ar2S(202)026&Vi 


+A2Ar2C2  92bbV1 

-\-A2Y292  |AS(202)  +  02AC(202)j  S2 
+A2b  [a02C(202)  +  AS(202)]  v2r2 
+2A26r2  [Ac(202)  -  A02S(202)]  02V2 
+Ar2/25(202)  [e2h  +  i>(\  mpL 
+2Ar2/2MpL  ^C(292)92b(  +  eC9292AY  +  eS02Ar] 

+2AY2l2MpL  e92C92aXC{92  +  £2)  —  eS92aXC(92  4-  £2)  +  eS92aXS(92  +  £2)(02  +  be1)} 

+  'bTe MpL  [2<?2C(202)/2Ar  +  S(202)/2Ar  +  e92S92 ] 

+(^1  +  92  +  qtp')Tel2Mpi,  Jf>02^2  A S92S(92  +  £2)j 
+($i  +  92  +  q^')Tel2Mpi  \^AYC9292S(92  +  C2)  +  AYS92C(92  +  C2 ) (^2  +  6f/)J 

+9iTlieaXMPL 

—qYipMpL  |Al72S02  +  AYl2C9292  +  edAj 

+^r2^c(2^2)/2ArMP£ 

+^2reAn2Mp£,  ^C($2  +  £2X^2  +  be')(aX  —  1)S02  4-  S(92  +  £2)aXS92  +  S(92  +  C2)(aA  —  l)C0202j 
(92reAr/2MpZ,  [s02(92(aA  +  1  )C(02  +  &)  -  C92aXC(92  +  C2)  +  C02(aA  +  1  )S(02  +  C2)(<?2  +  6e')] 

—aS9292Si 


-9i'SCieThMpL  -  92C292l\AY2MpL 


+9ii>eS92eTMPL  -  9\qi!>eYS£\MPL 


~{AY)2Yel2S92MpL  -  AbMpLYd2YS{292)/2 
—(9i  +  92  +  qrfi')MpLAYeYl2S92S(92  +  C2) 


—9\Mpi,{9i  +  92  ■+•  qip')eYl2S92 


WJ 


. . .  Also 


+AgI>502I72A/pL  4*  aA02e(c*A  —  l)rC02/2A/P£, 


-aX MpL(0x  +  Qi  +  qil>')er(aX  -  1  )l2C02 


+(0i  +  Bi  +  qil>')bc'  SOieTliMpi 


+aq\ipeTMPL  —  q2ip'il>eTS(i(aX  +  1  )Mpl 


-8ir^hSCieTMpL(aX  +  1) 


+ASe 


61B41  +  C41  = 

— ASd^diSt 

—\02s(qX  —  l)Ar  CO^l^Mpi  +  A02e(aA  —  1)  AT 30202^2  Afpi, 
+X(0x  +  O2  +  vP'YMpl] 2  [Ar(aA  —  \)C&2  +  ArdAC02] 
-X(0i  +02  +  qVYMpLl2  [Ar(aA  -  1)SM2  -  oa] 
+#iAe(aA  +  l)Mpj,lxS(02  +  Ci  +  C2)(^2  +  Q*P'  +  be') 
—qXtpeMpi,  [Ar  +  aXC(02  4-  Ci  +  C2)j 
+qX\l)eMpi (oA  +  l)i>(02  +  Ci  +  C2)  +  W  +  bt'J 

+aSio  +  tMp^lySOi  XC(02  +  C2)A2rJ 
~(0i  +  0j  +  qV)7  MpLe\l2St2 
-qip(0\  +02  +  qrp')Mpie\S(02  +  Ci  +  C2) 

—bt(0\  +02  +  qip')MPLe\SC2 
— 0i  Ar«  A/i  Mpl  +  AqTrl>eXMpi 
-02\T2l2eAXMpL  [S(02  +  C2)S02  -  C07C(02  +  C2)] 
-a\(0i  +  02  +  qip')MpLe\\2  [AfCSj  -  1] 


CM' 


I'TX.TY.*  'rC'\'''JvVF V^V  ' 


— (0i  +  O2  4-  qip')be'  Mpi,eXl2S^2 
—be Xe1 MpLS{02  +  Ci  4-  C2)  [/Mi  +  jV’J 
+aq\2ipeC(62  4-  Ci  4-  C2  )AfP£, 
-q2il>'ipeA.rS(i\MpL 
-0iqip'MpLhSCie\T\ 

. . .  Also 

qBsi  4-  C51  = 

—  A2lpbS($2  +  Cl)^2^3 

— A2^l>{0\  4-  02  +  2qil>')S(02  +  Ci)  [(^2  4-  qip')S3  4-  6V3] 
+A2Sa0i^'qrpS(02  +  Ci) 

+A2SaO\ip'  [(#2  +  qi>')  [C(0 2  +  Ci)?^  ~  hS(02  +  Ci)]] 

— A2tl>(0i  4-  02  +  2qij>')bC(02  4-  Ci)(^2  +  qifi')\/ 3 
+A2V3b9\rl>'  [q*l>C(0  2  4-  Ci)  —  hS(02  +  Ci)] 

+A2V3W1  tpqxpC(02  +  Ci ) 

-A2V3b01iJ>(02  4-  qr(>')  [qJ>S(0 2  4-  Cl)  +  hC{02  4-  Cl)] 
+0irpMPLTe  [ASCi  +  2AgV,/] 

—br(>eAfpi,S(02  4-  Ci)(^2  4-  W) 

+2 (#,s  4-  6irl>’  +  02l>')el2  [aA5C2  +  (oA  -  l)**]  Mpi 

+V>'Are/2Mp£  [SM2  +  ArS02S(02  +  C2)] 

+0' Are/; Mpi Ar  [cMaSfa  4-  C2)  4-  S02C(02  +  Ci)(*a  +  if')] 
— 0\il>'  MplS(02  4-  Ci)(^2  4-  WVih 
+0\i>' MplC(02  4-  Ci)(^2  4-  q^')(hq^>  -  &M) 


«\VJ 


1 


Ws 

■»**> 

.•V' 

■V.N 
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if 

i 

k 

fi 


+d1Tl>'MpLS(62+(l)(hqtl>  -  wlf) 

+d\il>' MpieTlz  [aS02  +  ACM2] 

—Slip' Mpi,eli  [s(02  +  Cl  +  C2)  +  C(B 2  +  Ci  +  C2)(^2  +  qip1  +  6e')J 
+4>MpL,(6\  +  02  +  2qtp')eaXS(6\  +  Ci  4-  C2) 

~^>MP£,(^i  +  02  +  29^')/2S(02  +  Ci)(^2  +  qi>') 

+ipMpL(01  +02+  2qxP')eMpL(a\  -  1  )C(02  +  Ci  +  C2)(^2  +  q<l>'  +  be') 
+i>(ip'eMpL  [dASC2  +  («*  -  l)ie'] 

+btyl>' eMpL  ^aAS(^j  +  Ci  +  C2)  +  (QA  —  1  )C(02  4-  Ci  +  C2)(^2  +  q*P'  + 

-Ar rpMpL  [An2S02  +  Ar/2CM2  +  cAa] 

+a\xP'el2MpL  [Ar(aA  -  1  )C07  -  Ar(aA  -  1)S0202  -  <*a] 
+tP'be'el2  [dASC2  +  (<*A  -  1)6^] 

+rl>'b€'el2MpL  [«A5C2  +  (c*A  -  l)6f'j 
—ip'be'  el2 r A/p£,  ^AS^2  +  AC0202j 

—aXrpeMpL  ^dAC(^2  +  Ci  +  C2)  —  (<*A  +  1)S(02  +  Ci  +  C2)(02  +  Ci  +  C2)] 
+2qil>'rl>eTMpL  [ASCi(aA  +  1)  +  \qrp'(aX  +  l)/2  +  ASCidA] 
+91iP'eTllMpL  [A5Ci(aA  +  1)  +  AqV(aX  +  1)  +  ASCidA] 
-A\d\*qVs  +  A20ibliS(02  +  Ci  )rp'V3 
—S3A20i(9\  +02  +  q^P')S(02  +  Ci)^  —  hil>r\ 

— S'3j42^i(<?i  +  02  +  qip')qipC(0  2  +  Ci)V’/ 

+A2b(0i  +  02  +  qi>')qi(,C(02  +  CiJ^Vs 
+^29^1  +02  +  qi>')S{02  +  Ci)V>'53 
—A2b0i(0i  +02  +  q^>')C(02  +  CiWW  —  fiV’'] 


J  i  -  r-  i  i  i  ‘  i~*  i  ~  r~ii  ~  i  ~ii  ~  r-ii-ii-.i-.i-.i  i  ~  i  iii  '.i  ‘i  ~~  hrvr'1*  r*  •-*  **i  r*i  n* 


+A2b0i(6\  +  $2  +  q^>')V3qipS(92  +  Ci)^ 

-tfiVeAr  hM,L 

+Oib(ip'liS(02  +  (i\)MpL 

+qbipeS(02  +  Ci  )4>'Mpl 

-(Oi  +02  +  qil>')0iMPL  [C(0 2  +  Ci  Wihq^  —  hb()  -  S(9 2  +  CiWhh] 
~(9i  +02  +  qi>')0\Mpi  [S(02  +  -  el\C{02  +  Ci  +  C2W) 

+tjj'qtp(0i  +  02  +  q^')hMpLS{9  2  +  Ci) 

~^'qi>(0i  +62  +  qti>')MpLe(a\  -  1  )C(02  +  Ci  +  C2) 


-be'0ie(a\  -  1)MplIiC(02  +  Ci  +  Cz)^' 


— 0idAe(aA  +  1)MplIiS(02  +  Ci  +  hW 


-6ge'V>c(aA  -  1)C(02  +  Cl  +  hW  MpL 
—aqXipe(aX  +  1)S(02  +  Ci  +  WMpL 


And  finally 


-^i#'fiV',eAr(aA  +  l)MpL 


+9MpL[l2CW-eS(l3  +  C2)4’'} 


+jm2/2C  fhp’ /2 


bBeiCn  = 


-A20lll(02  +  qi/>')S(02  +  Cl )  Vs 
+A2AT2Ci02b\Vl 


-1A2M2C02SO202b'AVl 


-O\(.MplI\S{02  +  Cl)(^2  +  #') 


4 


Jk 

mm 


-bqe'il>e'e(aX  -  l)C(67  +  Ci  +  C2 )MpL 


-aq\ipe('(a\  +  1)S(02  +  Cl  +  C2  )MpL 
+bV7  -  gMpLeS((3  +  W 

Some  of  the  variables  appearing  in  these  equations  ,such  as  Si,  S 
have  not  been  previously  defined,  and  therefore  will  be  listed  below 

Si  =  SoPV\dyi 

Si  =  fo'pvUvi 

S3  =  fo’PlftdlH 
S4  =  fcpdyi 
St  =  /r1(/,)/0',Ai(i/2)<te 
5«  =  /o^JlyOrUvOrUvOdyx 

Si  =  /o^lvOrifyOr^yxidyi 

5s  =  r  l(h)ih 

S9  =  fi3l(yi)*i(yi)*i(yi)dyi 
Su>  =  fo*GJ(yi)K(vi)K(vi)dyi 


Vi  =  ft*  f*l{yi)dyi 
vi  =  fo’pv(  i(yi)dyi 
V 3  =  fo  P<i(vi)dy7 

v*  =  Jo  pyi^i(yi)dyi 


V5  =  /0‘p^i(yi)<fyi 
V6  =  Jo' EI(yi)(xi>")2  dy\ 
V7  =  f‘>EI(y2)((")2dy, 
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